| 1 | /* |
| 2 | * Code generation for system model 'fusionAlg' |
| 3 | * |
| 4 | * Model : fusionAlg |
| 5 | * Model version : 1.375 |
| 6 | * Simulink Coder version : 9.0 (R2018b) 24-May-2018 |
| 7 | * C source code generated on : Fri Jan 29 10:17:07 2021 |
| 8 | * |
| 9 | * Note that the functions contained in this file are part of a Simulink |
| 10 | * model, and are not self-contained algorithms. |
| 11 | */ |
| 12 | |
| 13 | #include "fusionAlg_trc_ptr.h" |
| 14 | #include "rti_initref_cpp.h" |
| 15 | #include "fusionAlg.h" |
| 16 | #include "fusionAlg_private.h" |
| 17 | #include "plook_u32f_lincka.h" |
| 18 | |
| 19 | P_fusionAlg_T fusionAlg_P_g = { |
| 20 | 1129.0, |
| 21 | 1110.0, |
| 22 | 1116.0, |
| 23 | 1116.0, |
| 24 | 1116.0, |
| 25 | 1011.0, |
| 26 | 101011.0, |
| 27 | 1012.0, |
| 28 | 0.0F, |
| 29 | 0.0F, |
| 30 | 0.0F, |
| 31 | 0.0F, |
| 32 | 0.0F, |
| 33 | 0.0F, |
| 34 | 0.0F, |
| 35 | 0.0F, |
| 36 | 0.0F, |
| 37 | 0.0F, |
| 38 | 0.0F, |
| 39 | 0.0F, |
| 40 | 0.0F, |
| 41 | 0.0F, |
| 42 | 0.0F, |
| 43 | 0.0F, |
| 44 | 0.0F, |
| 45 | 0.0F, |
| 46 | 0.0F, |
| 47 | 0.0F, |
| 48 | 0.0F, |
| 49 | 0.0F, |
| 50 | 0.0F, |
| 51 | 0.0F, |
| 52 | 0.0F, |
| 53 | 0.0F, |
| 54 | 0.0F, |
| 55 | 0.0F, |
| 56 | 0.0F, |
| 57 | 0.0F, |
| 58 | 0.0F, |
| 59 | 0.0F, |
| 60 | 0.0F, |
| 61 | 0.0F, |
| 62 | 0.0F, |
| 63 | 0.0F, |
| 64 | 0.0F, |
| 65 | 0.0F, |
| 66 | 0.0F, |
| 67 | 0.0F, |
| 68 | 0.0F, |
| 69 | 0.0F, |
| 70 | 0.0F, |
| 71 | 0.0F, |
| 72 | 0.0F, |
| 73 | 0.0F, |
| 74 | 0.0F, |
| 75 | 0.0F, |
| 76 | 0.0F, |
| 77 | 0.0F, |
| 78 | 0.0F, |
| 79 | 0.0F, |
| 80 | 0.0F, |
| 81 | 0.0F, |
| 82 | 0.0F, |
| 83 | 0.0F, |
| 84 | 0.0F, |
| 85 | 0.0F, |
| 86 | 0.0F, |
| 87 | 0.0F, |
| 88 | 0.0F, |
| 89 | 0.0F, |
| 90 | 0.0F, |
| 91 | 0.0F, |
| 92 | 0.0F, |
| 93 | 0.0F, |
| 94 | 0.0F, |
| 95 | 0.0F, |
| 96 | 0.0F, |
| 97 | 0.0F, |
| 98 | 0.0F, |
| 99 | 0.0F, |
| 100 | 0.0F, |
| 101 | 0.0F, |
| 102 | 0.0F, |
| 103 | 0.0F, |
| 104 | 0.0F, |
| 105 | 0.0F, |
| 106 | 0.0F, |
| 107 | 0.0F, |
| 108 | 0.0F, |
| 109 | 0.0F, |
| 110 | 0.0F, |
| 111 | 0.0F, |
| 112 | 0.0F, |
| 113 | 0.0F, |
| 114 | 0.0F, |
| 115 | 0.0F, |
| 116 | 0.0F, |
| 117 | 0.0F, |
| 118 | 0.0F, |
| 119 | 0.0F, |
| 120 | 0.0F, |
| 121 | 0.0F, |
| 122 | 0.0F, |
| 123 | 0.0F, |
| 124 | 0.0F, |
| 125 | 0.0F, |
| 126 | 0.0F, |
| 127 | 0.0F, |
| 128 | 0.0F, |
| 129 | 0.0F, |
| 130 | 0.0F, |
| 131 | 0.0F, |
| 132 | 0.0F, |
| 133 | 0.0F, |
| 134 | 0.0F, |
| 135 | 0.0F, |
| 136 | 0.0F, |
| 137 | 0.0F, |
| 138 | 0.0F, |
| 139 | 0.0F, |
| 140 | 0.0F, |
| 141 | 0.0F, |
| 142 | 0.0F, |
| 143 | 0.0F, |
| 144 | 0.0F, |
| 145 | 0.0F, |
| 146 | 0.0F, |
| 147 | 0.0F, |
| 148 | 0.0F, |
| 149 | 0.0F, |
| 150 | 0.0F, |
| 151 | 0.0F, |
| 152 | 0.0F, |
| 153 | 0.0F, |
| 154 | 0.0F, |
| 155 | 0.0F, |
| 156 | 0.0F, |
| 157 | 0.0F, |
| 158 | 0.0F, |
| 159 | 0.0F, |
| 160 | 0.0F, |
| 161 | 0.0F, |
| 162 | 0.0F, |
| 163 | 0.0F, |
| 164 | 0.0F, |
| 165 | 0.0F, |
| 166 | 0.0F, |
| 167 | 0.0F, |
| 168 | 0.0F, |
| 169 | 0.0F, |
| 170 | 0.0F, |
| 171 | 0.0F, |
| 172 | 0.0F, |
| 173 | 0.0F, |
| 174 | 0.0F, |
| 175 | 0.0F, |
| 176 | 0.0F, |
| 177 | 0.0F, |
| 178 | 0.0F, |
| 179 | 0.0F, |
| 180 | 0.0F, |
| 181 | 0.0F, |
| 182 | 0.0F, |
| 183 | 0.0F, |
| 184 | 0.0F, |
| 185 | 0.0F, |
| 186 | 0.0F, |
| 187 | 0.0F, |
| 188 | 0.0F, |
| 189 | 0.0F, |
| 190 | 0.0F, |
| 191 | 0.0F, |
| 192 | 0.0F, |
| 193 | 0.0F, |
| 194 | 0.0F, |
| 195 | 0.0F, |
| 196 | 0.0F, |
| 197 | 0.0F, |
| 198 | 0.0F, |
| 199 | 0.0F, |
| 200 | 0.0F, |
| 201 | 0.0F, |
| 202 | 0.0F, |
| 203 | 0.0F, |
| 204 | 0.0F, |
| 205 | 0.0F, |
| 206 | 0.0F, |
| 207 | 0.0F, |
| 208 | 0.0F, |
| 209 | 0.0F, |
| 210 | 0.0F, |
| 211 | 0.0F, |
| 212 | 0.0F, |
| 213 | 0.0F, |
| 214 | 0.0F, |
| 215 | 0.0F, |
| 216 | 0.0F, |
| 217 | 0.0F, |
| 218 | 0.0F, |
| 219 | 0.0F, |
| 220 | 0.0F, |
| 221 | 0.0F, |
| 222 | 0.0F, |
| 223 | 0.0F, |
| 224 | 0.0F, |
| 225 | 0.0F, |
| 226 | 0.0F, |
| 227 | 0.0F, |
| 228 | 0.0F, |
| 229 | 0.0F, |
| 230 | 0.0F, |
| 231 | 0.0F, |
| 232 | 0.0F, |
| 233 | 0.0F, |
| 234 | 0.0F, |
| 235 | 0.0F, |
| 236 | 0.0F, |
| 237 | 0.0F, |
| 238 | 0.0F, |
| 239 | 0.0F, |
| 240 | 0.0F, |
| 241 | 0.0F, |
| 242 | 0.0F, |
| 243 | 0.0F, |
| 244 | 0.0F, |
| 245 | 0.0F, |
| 246 | 0.0F, |
| 247 | 0.0F, |
| 248 | 0.0F, |
| 249 | 0.0F, |
| 250 | 0.0F, |
| 251 | 0.0F, |
| 252 | 0.0F, |
| 253 | 0.0F, |
| 254 | 0.0F, |
| 255 | 0.0F, |
| 256 | 0.0F, |
| 257 | 0.0F, |
| 258 | 0.0F, |
| 259 | 0.0F, |
| 260 | 0.0F, |
| 261 | 0.0F, |
| 262 | 0.0F, |
| 263 | 0.0F, |
| 264 | 0.0F, |
| 265 | 0.0F, |
| 266 | 0.0F, |
| 267 | 0.0F, |
| 268 | 0.0F, |
| 269 | 0.0F, |
| 270 | 0.0F, |
| 271 | 0.0F, |
| 272 | 0.0F, |
| 273 | 0.0F, |
| 274 | 0.0F, |
| 275 | 0.0F, |
| 276 | 0.0F, |
| 277 | 0.0F, |
| 278 | 0.0F, |
| 279 | 0.0F, |
| 280 | 0.0F, |
| 281 | 0.0F, |
| 282 | 0.0F, |
| 283 | 0.0F, |
| 284 | 0.0F, |
| 285 | 0.0F, |
| 286 | 0.0F, |
| 287 | 0.0F, |
| 288 | 0.0F, |
| 289 | 0.0F, |
| 290 | 0.0F, |
| 291 | 0.0F, |
| 292 | 0.0F, |
| 293 | 0.0F, |
| 294 | 0.0F, |
| 295 | 0.0F, |
| 296 | 0.0F, |
| 297 | 0.0F, |
| 298 | 0.0F, |
| 299 | 0.0F, |
| 300 | 0.0F, |
| 301 | 0.0F, |
| 302 | 0.0F, |
| 303 | 0.0F, |
| 304 | 0.0F, |
| 305 | 0.0F, |
| 306 | 0.0F, |
| 307 | 0.0F, |
| 308 | 0.0F, |
| 309 | 0.0F, |
| 310 | 0.0F, |
| 311 | 0.0F, |
| 312 | 0.0F, |
| 313 | 0.0F, |
| 314 | 0.0F, |
| 315 | 0.0F, |
| 316 | 0.0F, |
| 317 | 0.0F, |
| 318 | 0.0F, |
| 319 | 0.0F, |
| 320 | 0.0F, |
| 321 | 0.0F, |
| 322 | 0.0F, |
| 323 | 0.0F, |
| 324 | 0.0F, |
| 325 | 0.0F, |
| 326 | 0.0F, |
| 327 | 0.0F, |
| 328 | 0.0F, |
| 329 | 0.0F, |
| 330 | 0.0F, |
| 331 | 0.0F, |
| 332 | 0.0F, |
| 333 | 0.0F, |
| 334 | 0.0F, |
| 335 | 0.0F, |
| 336 | 0.0F, |
| 337 | 0.0F, |
| 338 | 0.0F, |
| 339 | 0.0F, |
| 340 | 0.0F, |
| 341 | 0.0F, |
| 342 | 0.0F, |
| 343 | 0.0F, |
| 344 | 0.0F, |
| 345 | 0.0F, |
| 346 | 0.0F, |
| 347 | 0.0F, |
| 348 | 0.0F, |
| 349 | 0.0F, |
| 350 | 0.0F, |
| 351 | 0.0F, |
| 352 | 0.0F, |
| 353 | 0.0F, |
| 354 | 0.0F, |
| 355 | 0.0F, |
| 356 | 0.0F, |
| 357 | 0.0F, |
| 358 | 0.0F, |
| 359 | 0.0F, |
| 360 | 0.0F, |
| 361 | 0.0F, |
| 362 | 0.0F, |
| 363 | 0.0F, |
| 364 | 0.0F, |
| 365 | 0.0F, |
| 366 | 0.0F, |
| 367 | 0.0F, |
| 368 | 0.0F, |
| 369 | 0.0F, |
| 370 | 0.0F, |
| 371 | 0.0F, |
| 372 | 0.0F, |
| 373 | 0.0F, |
| 374 | 0.0F, |
| 375 | 0.0F, |
| 376 | 0.0F, |
| 377 | 0.0F, |
| 378 | 0.0F, |
| 379 | 0.0F, |
| 380 | 0.0F, |
| 381 | 0.0F, |
| 382 | 0.0F, |
| 383 | 0.0F, |
| 384 | 0.0F, |
| 385 | 0.0F, |
| 386 | 0.0F, |
| 387 | 0.0F, |
| 388 | 0.0F, |
| 389 | 0.0F, |
| 390 | 0.0F, |
| 391 | 0.0F, |
| 392 | 0.0F, |
| 393 | 0.0F, |
| 394 | 0.0F, |
| 395 | 0.0F, |
| 396 | 0.0F, |
| 397 | 0.0F, |
| 398 | 0.0F, |
| 399 | 0.0F, |
| 400 | 0.0F, |
| 401 | 0.0F, |
| 402 | 0.0F, |
| 403 | 0.0F, |
| 404 | 0.0F, |
| 405 | 0.0F, |
| 406 | 0.0F, |
| 407 | 0.0F, |
| 408 | 0.0F, |
| 409 | 0.0F, |
| 410 | 0.0F, |
| 411 | 0.0F, |
| 412 | 0.0F, |
| 413 | 0.0F, |
| 414 | 0.0F, |
| 415 | 0.0F, |
| 416 | 0.0F, |
| 417 | 0.0F, |
| 418 | 0.0F, |
| 419 | 0.0F, |
| 420 | 0.0F, |
| 421 | 0.0F, |
| 422 | 0.0F, |
| 423 | 0.0F, |
| 424 | 0.0F, |
| 425 | 0.0F, |
| 426 | 0.0F, |
| 427 | 0.0F, |
| 428 | 0.0F, |
| 429 | 0.0F, |
| 430 | 0.0F, |
| 431 | 0.0F, |
| 432 | 0.0F, |
| 433 | 0.0F, |
| 434 | 0.0F, |
| 435 | 0.0F, |
| 436 | 0.0F, |
| 437 | 0.0F, |
| 438 | 0.0F, |
| 439 | 0.0F, |
| 440 | 0.0F, |
| 441 | 0.0F, |
| 442 | 0.0F, |
| 443 | 0.0F, |
| 444 | 0.0F, |
| 445 | 0.0F, |
| 446 | 0.0F, |
| 447 | 0.0F, |
| 448 | 0.0F, |
| 449 | 0.0F, |
| 450 | 0.0F, |
| 451 | 0.0F, |
| 452 | 0.0F, |
| 453 | 0.0F, |
| 454 | 0.0F, |
| 455 | 0.0F, |
| 456 | 0.0F, |
| 457 | 0.0F, |
| 458 | 0.0F, |
| 459 | 0.0F, |
| 460 | 0.0F, |
| 461 | 0.0F, |
| 462 | 0.0F, |
| 463 | 0.0F, |
| 464 | 0.0F, |
| 465 | 0.0F, |
| 466 | 0.0F, |
| 467 | 0.0F, |
| 468 | 0.0F, |
| 469 | 0.0F, |
| 470 | 0.0F, |
| 471 | 0.0F, |
| 472 | 0.0F, |
| 473 | 0.0F, |
| 474 | 0.0F, |
| 475 | 0.0F, |
| 476 | 0.0F, |
| 477 | 0.0F, |
| 478 | 0.0F, |
| 479 | 0.0F, |
| 480 | 0.0F, |
| 481 | 0.0F, |
| 482 | 0.0F, |
| 483 | 0.0F, |
| 484 | 0.0F, |
| 485 | 0.0F, |
| 486 | 0.0F, |
| 487 | 0.0F, |
| 488 | 0.0F, |
| 489 | 0.0F, |
| 490 | 0.0F, |
| 491 | 0.0F, |
| 492 | 0.0F, |
| 493 | 0.0F, |
| 494 | 0.0F, |
| 495 | 0.0F, |
| 496 | 0.0F, |
| 497 | 0.0F, |
| 498 | 0.0F, |
| 499 | 0.0F, |
| 500 | 0.0F, |
| 501 | 0.0F, |
| 502 | 0.0F, |
| 503 | 0.0F, |
| 504 | 0.0F, |
| 505 | 0.0F, |
| 506 | 0.0F, |
| 507 | 0.0F, |
| 508 | 0.0F, |
| 509 | 0.0F, |
| 510 | 0.0F, |
| 511 | 0.0F, |
| 512 | 0.0F, |
| 513 | 0.0F, |
| 514 | 0.0F, |
| 515 | 0.0F, |
| 516 | 0.0F, |
| 517 | 0.0F, |
| 518 | 0.0F, |
| 519 | 0.0F, |
| 520 | 0.0F, |
| 521 | 0.0F, |
| 522 | 0.0F, |
| 523 | 0.0F, |
| 524 | 0.0F, |
| 525 | 0.0F, |
| 526 | 0.0F, |
| 527 | 0.0F, |
| 528 | 0.0F, |
| 529 | 0.0F, |
| 530 | 0.0F, |
| 531 | 0.0F, |
| 532 | 0.0F, |
| 533 | 0.0F, |
| 534 | 0.0F, |
| 535 | 0.0F, |
| 536 | 0.0F, |
| 537 | 0.0F, |
| 538 | 0.0F, |
| 539 | 0.0F, |
| 540 | 0.0F, |
| 541 | 0.0F, |
| 542 | 0.0F, |
| 543 | 0.0F, |
| 544 | 0.0F, |
| 545 | 0.0F, |
| 546 | 0.0F, |
| 547 | 0.0F, |
| 548 | 0.0F, |
| 549 | 0.0F, |
| 550 | 0.0F, |
| 551 | 0.0F, |
| 552 | 0.0F, |
| 553 | 0.0F, |
| 554 | 0.0F, |
| 555 | 0.0F, |
| 556 | 0.0F, |
| 557 | 0.0F, |
| 558 | 0.0F, |
| 559 | 0.0F, |
| 560 | 0.0F, |
| 561 | 0.0F, |
| 562 | 0.0F, |
| 563 | 0.0F, |
| 564 | 0.0F, |
| 565 | 0.0F, |
| 566 | 0.0F, |
| 567 | 0.0F, |
| 568 | 0.0F, |
| 569 | 0.0F, |
| 570 | 0.0F, |
| 571 | 0.0F, |
| 572 | 0.0F, |
| 573 | 0.0F, |
| 574 | 0.0F, |
| 575 | 0.0F, |
| 576 | 0.0F, |
| 577 | 0.0F, |
| 578 | 0.0F, |
| 579 | 0.0F, |
| 580 | 0.0F, |
| 581 | 0.0F, |
| 582 | 0.0F, |
| 583 | 0.0F, |
| 584 | 0.0F, |
| 585 | 0.0F, |
| 586 | 0.0F, |
| 587 | 0.0F, |
| 588 | 0.0F, |
| 589 | 0.0F, |
| 590 | 0.0F, |
| 591 | 0.0F, |
| 592 | 0.0F, |
| 593 | 0.0F, |
| 594 | 0.0F, |
| 595 | 0.0F, |
| 596 | 0.0F, |
| 597 | 0.0F, |
| 598 | 0.0F, |
| 599 | 0.0F, |
| 600 | 0.0F, |
| 601 | 0.0F, |
| 602 | 0.0F, |
| 603 | 0.0F, |
| 604 | 0.0F, |
| 605 | 0.0F, |
| 606 | 0.0F, |
| 607 | 0.0F, |
| 608 | 0.0F, |
| 609 | 0.0F, |
| 610 | 0.0F, |
| 611 | 0.0F, |
| 612 | 0.0F, |
| 613 | 0.0F, |
| 614 | 0.0F, |
| 615 | 0.0F, |
| 616 | 0.0F, |
| 617 | 0.0F, |
| 618 | 0.0F, |
| 619 | 0.0F, |
| 620 | 0.0F, |
| 621 | 0.0F, |
| 622 | 0.0F, |
| 623 | 0.0F, |
| 624 | 0.0F, |
| 625 | 0.0F, |
| 626 | 0.0F, |
| 627 | 0.0F, |
| 628 | 0.0F, |
| 629 | 0.0F, |
| 630 | 0.0F, |
| 631 | 0.0F, |
| 632 | 0.0F, |
| 633 | 0.0F, |
| 634 | 0.0F, |
| 635 | 0.0F, |
| 636 | 0.0F, |
| 637 | 0.0F, |
| 638 | 0.0F, |
| 639 | 0.0F, |
| 640 | 0.0F, |
| 641 | 0.0F, |
| 642 | 0.0F, |
| 643 | 0.0F, |
| 644 | 0.0F, |
| 645 | 0.0F, |
| 646 | 0.0F, |
| 647 | 0.0F, |
| 648 | 0.0F, |
| 649 | 0.0F, |
| 650 | 0.0F, |
| 651 | 0.0F, |
| 652 | 0.0F, |
| 653 | 0.0F, |
| 654 | 0.0F, |
| 655 | 0.0F, |
| 656 | 0.0F, |
| 657 | 0.0F, |
| 658 | 0.0F, |
| 659 | 0.0F, |
| 660 | 0.0F, |
| 661 | 0.0F, |
| 662 | 0.0F, |
| 663 | 0.0F, |
| 664 | 0.0F, |
| 665 | 0.0F, |
| 666 | 0.0F, |
| 667 | 0.0F, |
| 668 | 0.0F, |
| 669 | 0.0F, |
| 670 | 0.0F, |
| 671 | 0.0F, |
| 672 | 0.0F, |
| 673 | 0.0F, |
| 674 | 0.0F, |
| 675 | 0.0F, |
| 676 | 0.0F, |
| 677 | 0.0F, |
| 678 | 0.0F, |
| 679 | 0.0F, |
| 680 | 0.0F, |
| 681 | 0.0F, |
| 682 | 0.0F, |
| 683 | 0.0F, |
| 684 | 0.0F, |
| 685 | 0.0F, |
| 686 | 0.0F, |
| 687 | 0.0F, |
| 688 | 0.0F, |
| 689 | 0.0F, |
| 690 | 0.0F, |
| 691 | 0.0F, |
| 692 | 0.0F, |
| 693 | 0.0F, |
| 694 | 0.0F, |
| 695 | 0.0F, |
| 696 | 0.0F, |
| 697 | 0.0F, |
| 698 | 0.0F, |
| 699 | 0.0F, |
| 700 | 0.0F, |
| 701 | 0.0F, |
| 702 | 0.0F, |
| 703 | 0.0F, |
| 704 | 0.0F, |
| 705 | 0.0F, |
| 706 | 0.0F, |
| 707 | 0.0F, |
| 708 | 0.0F, |
| 709 | 0.0F, |
| 710 | 0.0F, |
| 711 | 0.0F, |
| 712 | 0.0F, |
| 713 | 0.0F, |
| 714 | 0.0F, |
| 715 | 0.0F, |
| 716 | 0.0F, |
| 717 | 0.0F, |
| 718 | 0.0F, |
| 719 | 0.0F, |
| 720 | 0.0F, |
| 721 | 0.0F, |
| 722 | 0.0F, |
| 723 | 0.0F, |
| 724 | 0.0F, |
| 725 | 0.0F, |
| 726 | 0.0F, |
| 727 | 0.0F, |
| 728 | 0.0F, |
| 729 | 0.0F, |
| 730 | 0.0F, |
| 731 | 0.0F, |
| 732 | 0.0F, |
| 733 | 0.0F, |
| 734 | 0.0F, |
| 735 | 0.0F, |
| 736 | 0.0F, |
| 737 | 0.0F, |
| 738 | 0.0F, |
| 739 | 0.0F, |
| 740 | 0.0F, |
| 741 | 0.0F, |
| 742 | 0.0F, |
| 743 | 0.0F, |
| 744 | 0.0F, |
| 745 | 0.0F, |
| 746 | 0.0F, |
| 747 | 0.0F, |
| 748 | 0.0F, |
| 749 | 0.0F, |
| 750 | 0.0F, |
| 751 | 0.0F, |
| 752 | 0.0F, |
| 753 | 0.0F, |
| 754 | 0.0F, |
| 755 | 0.0F, |
| 756 | 0.0F, |
| 757 | 0.0F, |
| 758 | 0.0F, |
| 759 | 0.0F, |
| 760 | 0.0F, |
| 761 | 0.0F, |
| 762 | 0.0F, |
| 763 | 0.0F, |
| 764 | 0.0F, |
| 765 | 0.0F, |
| 766 | 0.0F, |
| 767 | 0.0F, |
| 768 | 0.0F, |
| 769 | 0.0F, |
| 770 | 0.0F, |
| 771 | 0.0F, |
| 772 | 0.0F, |
| 773 | 0.0F, |
| 774 | 0.0F, |
| 775 | 0.0F, |
| 776 | 0.0F, |
| 777 | 0.0F, |
| 778 | 0.0F, |
| 779 | 0.0F, |
| 780 | 0.0F, |
| 781 | 0.0F, |
| 782 | 0.0F, |
| 783 | 0.0F, |
| 784 | 0.0F, |
| 785 | 0.0F, |
| 786 | 0.0F, |
| 787 | 0.0F, |
| 788 | 0.0F, |
| 789 | 0.0F, |
| 790 | 0.0F, |
| 791 | 0.0F, |
| 792 | 0.0F, |
| 793 | 0.0F, |
| 794 | 0.0F, |
| 795 | 0.0F, |
| 796 | 0.0F, |
| 797 | 0.0F, |
| 798 | 0.0F, |
| 799 | 0.0F, |
| 800 | 0.0F, |
| 801 | 0.0F, |
| 802 | 0.0F, |
| 803 | 0.0F, |
| 804 | 0.0F, |
| 805 | 0.0F, |
| 806 | 0.0F, |
| 807 | 0.0F, |
| 808 | 0.0F, |
| 809 | 0.0F, |
| 810 | 0.0F, |
| 811 | 0.0F, |
| 812 | 0.0F, |
| 813 | 0.0F, |
| 814 | 0.0F, |
| 815 | 0.0F, |
| 816 | 0.0F, |
| 817 | 0.0F, |
| 818 | 0.0F, |
| 819 | 0.0F, |
| 820 | 0.0F, |
| 821 | 0.0F, |
| 822 | 0.0F, |
| 823 | 0.0F, |
| 824 | 0.0F, |
| 825 | 0.0F, |
| 826 | 0.0F, |
| 827 | 0.0F, |
| 828 | 0.0F, |
| 829 | 0.0F, |
| 830 | 0.0F, |
| 831 | 0.0F, |
| 832 | 0.0F, |
| 833 | 0.0F, |
| 834 | 0.0F, |
| 835 | 0.0F, |
| 836 | 1.0F, |
| 837 | |
| 838 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 839 | |
| 840 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 841 | |
| 842 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 843 | |
| 844 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 845 | 1.0F, |
| 846 | 1.0F, |
| 847 | 0.0F, |
| 848 | 0.0F, |
| 849 | |
| 850 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 851 | |
| 852 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 853 | |
| 854 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 855 | |
| 856 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 857 | 1.0F, |
| 858 | 1.0F, |
| 859 | 0.0F, |
| 860 | 0.0F, |
| 861 | |
| 862 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 863 | |
| 864 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 865 | |
| 866 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 867 | |
| 868 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 869 | 1.0F, |
| 870 | 1.0F, |
| 871 | 0.0F, |
| 872 | 0.0F, |
| 873 | |
| 874 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 875 | |
| 876 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 877 | |
| 878 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 879 | |
| 880 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 881 | 1.0F, |
| 882 | 1.0F, |
| 883 | 0.0F, |
| 884 | 0.0F, |
| 885 | |
| 886 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 887 | |
| 888 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 889 | |
| 890 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 891 | |
| 892 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 893 | 1.0F, |
| 894 | 1.0F, |
| 895 | 0.0F, |
| 896 | 0.0F, |
| 897 | |
| 898 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 899 | |
| 900 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 901 | |
| 902 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 903 | |
| 904 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 905 | 1.0F, |
| 906 | 1.0F, |
| 907 | 0.0F, |
| 908 | 0.0F, |
| 909 | |
| 910 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 911 | |
| 912 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 913 | |
| 914 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 915 | |
| 916 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 917 | 1.0F, |
| 918 | 1.0F, |
| 919 | 0.0F, |
| 920 | 0.0F, |
| 921 | |
| 922 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 923 | |
| 924 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 925 | |
| 926 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 927 | |
| 928 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 929 | 1.0F, |
| 930 | 1.0F, |
| 931 | 0.0F, |
| 932 | 0.0F, |
| 933 | |
| 934 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 935 | |
| 936 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 937 | |
| 938 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 939 | |
| 940 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 941 | 1.0F, |
| 942 | 1.0F, |
| 943 | 0.0F, |
| 944 | 0.0F, |
| 945 | |
| 946 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 947 | |
| 948 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 949 | |
| 950 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 951 | |
| 952 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 953 | 1.0F, |
| 954 | 1.0F, |
| 955 | 0.0F, |
| 956 | 0.0F, |
| 957 | |
| 958 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 959 | |
| 960 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 961 | |
| 962 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 963 | |
| 964 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 965 | 1.0F, |
| 966 | 1.0F, |
| 967 | 0.0F, |
| 968 | 0.0F, |
| 969 | |
| 970 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 971 | |
| 972 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 973 | |
| 974 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 975 | |
| 976 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 977 | 1.0F, |
| 978 | 1.0F, |
| 979 | 0.0F, |
| 980 | 0.0F, |
| 981 | |
| 982 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 983 | |
| 984 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 985 | |
| 986 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 987 | |
| 988 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 989 | 1.0F, |
| 990 | 1.0F, |
| 991 | 0.0F, |
| 992 | 0.0F, |
| 993 | |
| 994 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 995 | |
| 996 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 997 | |
| 998 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 999 | |
| 1000 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1001 | 1.0F, |
| 1002 | 1.0F, |
| 1003 | 0.0F, |
| 1004 | 0.0F, |
| 1005 | |
| 1006 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1007 | |
| 1008 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1009 | |
| 1010 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1011 | |
| 1012 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1013 | 1.0F, |
| 1014 | 1.0F, |
| 1015 | 0.0F, |
| 1016 | 0.0F, |
| 1017 | |
| 1018 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1019 | |
| 1020 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1021 | |
| 1022 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1023 | |
| 1024 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1025 | 1.0F, |
| 1026 | 1.0F, |
| 1027 | 0.0F, |
| 1028 | 0.0F, |
| 1029 | |
| 1030 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1031 | |
| 1032 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1033 | |
| 1034 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1035 | |
| 1036 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1037 | 1.0F, |
| 1038 | 1.0F, |
| 1039 | 0.0F, |
| 1040 | 0.0F, |
| 1041 | |
| 1042 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1043 | |
| 1044 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1045 | |
| 1046 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1047 | |
| 1048 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1049 | 1.0F, |
| 1050 | 1.0F, |
| 1051 | 0.0F, |
| 1052 | 0.0F, |
| 1053 | |
| 1054 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1055 | |
| 1056 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1057 | |
| 1058 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1059 | |
| 1060 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1061 | 1.0F, |
| 1062 | 1.0F, |
| 1063 | 0.0F, |
| 1064 | 0.0F, |
| 1065 | |
| 1066 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1067 | |
| 1068 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1069 | |
| 1070 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1071 | |
| 1072 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1073 | 1.0F, |
| 1074 | 1.0F, |
| 1075 | 0.0F, |
| 1076 | 0.0F, |
| 1077 | |
| 1078 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1079 | |
| 1080 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1081 | |
| 1082 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1083 | |
| 1084 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1085 | 1.0F, |
| 1086 | 1.0F, |
| 1087 | 0.0F, |
| 1088 | 0.0F, |
| 1089 | |
| 1090 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1091 | |
| 1092 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1093 | |
| 1094 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1095 | |
| 1096 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1097 | 1.0F, |
| 1098 | 1.0F, |
| 1099 | 0.0F, |
| 1100 | 0.0F, |
| 1101 | |
| 1102 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1103 | |
| 1104 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1105 | |
| 1106 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1107 | |
| 1108 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1109 | 1.0F, |
| 1110 | 1.0F, |
| 1111 | 0.0F, |
| 1112 | 0.0F, |
| 1113 | |
| 1114 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1115 | |
| 1116 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1117 | |
| 1118 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1119 | |
| 1120 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1121 | 1.0F, |
| 1122 | 1.0F, |
| 1123 | 0.0F, |
| 1124 | 0.0F, |
| 1125 | |
| 1126 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1127 | |
| 1128 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1129 | |
| 1130 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1131 | |
| 1132 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1133 | 1.0F, |
| 1134 | 1.0F, |
| 1135 | 0.0F, |
| 1136 | 0.0F, |
| 1137 | |
| 1138 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1139 | |
| 1140 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1141 | |
| 1142 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1143 | |
| 1144 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1145 | 1.0F, |
| 1146 | 1.0F, |
| 1147 | 0.0F, |
| 1148 | 0.0F, |
| 1149 | |
| 1150 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1151 | |
| 1152 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1153 | |
| 1154 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1155 | |
| 1156 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1157 | 1.0F, |
| 1158 | 1.0F, |
| 1159 | 0.0F, |
| 1160 | 0.0F, |
| 1161 | |
| 1162 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1163 | |
| 1164 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1165 | |
| 1166 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1167 | |
| 1168 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1169 | 1.0F, |
| 1170 | 1.0F, |
| 1171 | 0.0F, |
| 1172 | 0.0F, |
| 1173 | |
| 1174 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1175 | |
| 1176 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1177 | |
| 1178 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1179 | |
| 1180 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1181 | 1.0F, |
| 1182 | 1.0F, |
| 1183 | 0.0F, |
| 1184 | 0.0F, |
| 1185 | |
| 1186 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1187 | |
| 1188 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1189 | |
| 1190 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1191 | |
| 1192 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1193 | 1.0F, |
| 1194 | 1.0F, |
| 1195 | 0.0F, |
| 1196 | 0.0F, |
| 1197 | |
| 1198 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1199 | |
| 1200 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1201 | |
| 1202 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1203 | |
| 1204 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1205 | 1.0F, |
| 1206 | 1.0F, |
| 1207 | 0.0F, |
| 1208 | 0.0F, |
| 1209 | |
| 1210 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1211 | |
| 1212 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1213 | |
| 1214 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1215 | |
| 1216 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1217 | 1.0F, |
| 1218 | 1.0F, |
| 1219 | 0.0F, |
| 1220 | 0.0F, |
| 1221 | |
| 1222 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1223 | |
| 1224 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1225 | |
| 1226 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1227 | |
| 1228 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1229 | 1.0F, |
| 1230 | 1.0F, |
| 1231 | 0.0F, |
| 1232 | 0.0F, |
| 1233 | |
| 1234 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1235 | |
| 1236 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1237 | |
| 1238 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1239 | |
| 1240 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1241 | 1.0F, |
| 1242 | 1.0F, |
| 1243 | 0.0F, |
| 1244 | 0.0F, |
| 1245 | |
| 1246 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1247 | |
| 1248 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1249 | |
| 1250 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1251 | |
| 1252 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1253 | 1.0F, |
| 1254 | 1.0F, |
| 1255 | 0.0F, |
| 1256 | 0.0F, |
| 1257 | |
| 1258 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1259 | |
| 1260 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1261 | |
| 1262 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1263 | |
| 1264 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1265 | 1.0F, |
| 1266 | 1.0F, |
| 1267 | 0.0F, |
| 1268 | 0.0F, |
| 1269 | |
| 1270 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1271 | |
| 1272 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1273 | |
| 1274 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1275 | |
| 1276 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1277 | 1.0F, |
| 1278 | 1.0F, |
| 1279 | 0.0F, |
| 1280 | 0.0F, |
| 1281 | |
| 1282 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1283 | |
| 1284 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1285 | |
| 1286 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1287 | |
| 1288 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1289 | 1.0F, |
| 1290 | 1.0F, |
| 1291 | 0.0F, |
| 1292 | 0.0F, |
| 1293 | |
| 1294 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1295 | |
| 1296 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1297 | |
| 1298 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1299 | |
| 1300 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1301 | 1.0F, |
| 1302 | 1.0F, |
| 1303 | 0.0F, |
| 1304 | 0.0F, |
| 1305 | |
| 1306 | { 2.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 1.0F, 1.0F }, |
| 1307 | |
| 1308 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F }, |
| 1309 | |
| 1310 | { 0.0F, 2.0F, 3.0F, 4.0F, 5.0F, 1.0F, 6.0F, 7.0F, 0.0F }, |
| 1311 | |
| 1312 | { 0.0F, 1.0F, 2.0F, 3.0F, 4.0F, 5.0F, 6.0F, 7.0F, 8.0F }, |
| 1313 | 1.0F, |
| 1314 | 1.0F, |
| 1315 | 0.0F, |
| 1316 | 0.0F, |
| 1317 | 1U, |
| 1318 | 40U, |
| 1319 | 1U, |
| 1320 | 0U, |
| 1321 | 0U, |
| 1322 | 1U, |
| 1323 | 0U, |
| 1324 | 0U, |
| 1325 | 1U, |
| 1326 | 0U, |
| 1327 | 0U, |
| 1328 | 1U, |
| 1329 | 0U, |
| 1330 | 0U, |
| 1331 | 1U, |
| 1332 | 0U, |
| 1333 | 0U, |
| 1334 | 0U, |
| 1335 | 0U, |
| 1336 | 0U, |
| 1337 | 3U, |
| 1338 | 0U, |
| 1339 | 0U, |
| 1340 | 0U, |
| 1341 | 0U, |
| 1342 | 0U, |
| 1343 | 0U, |
| 1344 | 0U, |
| 1345 | 0U, |
| 1346 | 0U, |
| 1347 | 0U, |
| 1348 | 0U, |
| 1349 | 0U, |
| 1350 | 0U, |
| 1351 | 0U, |
| 1352 | 0U, |
| 1353 | 0U, |
| 1354 | 0U, |
| 1355 | 0U, |
| 1356 | 0U, |
| 1357 | 0U, |
| 1358 | 0U, |
| 1359 | 0U, |
| 1360 | 0U, |
| 1361 | 0U, |
| 1362 | 0U, |
| 1363 | 0U, |
| 1364 | 0U, |
| 1365 | 0U, |
| 1366 | 0U, |
| 1367 | 0U, |
| 1368 | 0U, |
| 1369 | 0U, |
| 1370 | 0U, |
| 1371 | 0U, |
| 1372 | 0U, |
| 1373 | 0U, |
| 1374 | 0U, |
| 1375 | 0U, |
| 1376 | 0U, |
| 1377 | 0U, |
| 1378 | 0U, |
| 1379 | 0U, |
| 1380 | 0U, |
| 1381 | 0U, |
| 1382 | 0U, |
| 1383 | 0U, |
| 1384 | 0U, |
| 1385 | 0U, |
| 1386 | 0U, |
| 1387 | 0U, |
| 1388 | 0U, |
| 1389 | 0U, |
| 1390 | 0U, |
| 1391 | 0U, |
| 1392 | 0U, |
| 1393 | 0U, |
| 1394 | 0U, |
| 1395 | 0U, |
| 1396 | 0U, |
| 1397 | 0U, |
| 1398 | 0U, |
| 1399 | 0U, |
| 1400 | 0U, |
| 1401 | 0U, |
| 1402 | 0U, |
| 1403 | 0U, |
| 1404 | 0U, |
| 1405 | 0U, |
| 1406 | 0U, |
| 1407 | 0U, |
| 1408 | 0U, |
| 1409 | 0U, |
| 1410 | 0U, |
| 1411 | 0U, |
| 1412 | 0U, |
| 1413 | 0U, |
| 1414 | 0U, |
| 1415 | 0U, |
| 1416 | 0U, |
| 1417 | 0U, |
| 1418 | 2U, |
| 1419 | 0U, |
| 1420 | 0U, |
| 1421 | 1U, |
| 1422 | 0U, |
| 1423 | 0U, |
| 1424 | 0, |
| 1425 | 0, |
| 1426 | 0, |
| 1427 | 0, |
| 1428 | 0, |
| 1429 | 0, |
| 1430 | 0, |
| 1431 | 0, |
| 1432 | 0, |
| 1433 | 0, |
| 1434 | 0, |
| 1435 | 0, |
| 1436 | 0, |
| 1437 | 0, |
| 1438 | 0, |
| 1439 | 0, |
| 1440 | 0, |
| 1441 | 0, |
| 1442 | 0, |
| 1443 | 0, |
| 1444 | 0, |
| 1445 | 0, |
| 1446 | 0, |
| 1447 | 0, |
| 1448 | 0, |
| 1449 | 0, |
| 1450 | 0, |
| 1451 | 0, |
| 1452 | 0, |
| 1453 | 0, |
| 1454 | 0, |
| 1455 | 0, |
| 1456 | 0, |
| 1457 | 0, |
| 1458 | 0, |
| 1459 | 0, |
| 1460 | 0, |
| 1461 | 0, |
| 1462 | 0, |
| 1463 | 0, |
| 1464 | 0, |
| 1465 | 0, |
| 1466 | 0, |
| 1467 | 0, |
| 1468 | 0, |
| 1469 | 0, |
| 1470 | 0, |
| 1471 | 0, |
| 1472 | 0, |
| 1473 | 0, |
| 1474 | 0, |
| 1475 | 0, |
| 1476 | 0, |
| 1477 | 0, |
| 1478 | 0, |
| 1479 | 0, |
| 1480 | 0, |
| 1481 | 0, |
| 1482 | 0, |
| 1483 | 0, |
| 1484 | 0, |
| 1485 | 0, |
| 1486 | 0, |
| 1487 | 0, |
| 1488 | 0, |
| 1489 | 0, |
| 1490 | 0, |
| 1491 | 0, |
| 1492 | 0, |
| 1493 | 0, |
| 1494 | 0, |
| 1495 | 0, |
| 1496 | 0, |
| 1497 | 0, |
| 1498 | 0, |
| 1499 | 0, |
| 1500 | 0, |
| 1501 | 0, |
| 1502 | 0, |
| 1503 | 0, |
| 1504 | 0, |
| 1505 | 0, |
| 1506 | 0, |
| 1507 | 0, |
| 1508 | 0, |
| 1509 | 0, |
| 1510 | 0, |
| 1511 | 0, |
| 1512 | 0, |
| 1513 | 0, |
| 1514 | 0, |
| 1515 | 0, |
| 1516 | 0, |
| 1517 | 0, |
| 1518 | 0, |
| 1519 | 0, |
| 1520 | 0, |
| 1521 | 0, |
| 1522 | 0, |
| 1523 | 0, |
| 1524 | 0, |
| 1525 | 0, |
| 1526 | 0, |
| 1527 | 0, |
| 1528 | 0, |
| 1529 | 0, |
| 1530 | 0, |
| 1531 | 0, |
| 1532 | 0, |
| 1533 | 0, |
| 1534 | 0, |
| 1535 | 0, |
| 1536 | 0, |
| 1537 | 0, |
| 1538 | 0, |
| 1539 | 0, |
| 1540 | 0, |
| 1541 | 0, |
| 1542 | 0, |
| 1543 | 0, |
| 1544 | 0, |
| 1545 | 0, |
| 1546 | 0, |
| 1547 | 0, |
| 1548 | 0, |
| 1549 | 0, |
| 1550 | 0, |
| 1551 | 0, |
| 1552 | 0, |
| 1553 | 0, |
| 1554 | 0, |
| 1555 | 0, |
| 1556 | 0, |
| 1557 | 0, |
| 1558 | 0, |
| 1559 | 0, |
| 1560 | 0, |
| 1561 | 0, |
| 1562 | 0, |
| 1563 | 0, |
| 1564 | 0, |
| 1565 | 0, |
| 1566 | 0, |
| 1567 | 0, |
| 1568 | 0, |
| 1569 | 0, |
| 1570 | 0, |
| 1571 | 0, |
| 1572 | 0, |
| 1573 | 0, |
| 1574 | 0, |
| 1575 | 0, |
| 1576 | 0, |
| 1577 | 0, |
| 1578 | 0, |
| 1579 | 0, |
| 1580 | 0, |
| 1581 | 0, |
| 1582 | 0, |
| 1583 | 0, |
| 1584 | 0U, |
| 1585 | 0U, |
| 1586 | 0U, |
| 1587 | 0U, |
| 1588 | 0U, |
| 1589 | 0U, |
| 1590 | 0U, |
| 1591 | 0U, |
| 1592 | 0U, |
| 1593 | 0U, |
| 1594 | 0U, |
| 1595 | 0U, |
| 1596 | 0U, |
| 1597 | 0U, |
| 1598 | 0U, |
| 1599 | 0U, |
| 1600 | 0U, |
| 1601 | 0U, |
| 1602 | 0U, |
| 1603 | 0U, |
| 1604 | 0U, |
| 1605 | 0U, |
| 1606 | 0U, |
| 1607 | 0U, |
| 1608 | 0U, |
| 1609 | 0U, |
| 1610 | 0U, |
| 1611 | 0U, |
| 1612 | 0U, |
| 1613 | 0U, |
| 1614 | 0U, |
| 1615 | 0U, |
| 1616 | 0U, |
| 1617 | 0U, |
| 1618 | 0U, |
| 1619 | 0U, |
| 1620 | 0U, |
| 1621 | 0U, |
| 1622 | 0U, |
| 1623 | 0U, |
| 1624 | 0U, |
| 1625 | 0U, |
| 1626 | 0U, |
| 1627 | 0U, |
| 1628 | 0U, |
| 1629 | 0U, |
| 1630 | 0U, |
| 1631 | 0U, |
| 1632 | 0U, |
| 1633 | 0U, |
| 1634 | 0U, |
| 1635 | 0U, |
| 1636 | 0U, |
| 1637 | 0U, |
| 1638 | 0U, |
| 1639 | 0U, |
| 1640 | 0U, |
| 1641 | 0U, |
| 1642 | 0U, |
| 1643 | 0U, |
| 1644 | 0U, |
| 1645 | 0U, |
| 1646 | 0U, |
| 1647 | 0U, |
| 1648 | 0U, |
| 1649 | 0U, |
| 1650 | 0U, |
| 1651 | 0U, |
| 1652 | 0U, |
| 1653 | 0U, |
| 1654 | 0U, |
| 1655 | 0U, |
| 1656 | 0U, |
| 1657 | 0U, |
| 1658 | 0U, |
| 1659 | 0U, |
| 1660 | 0U, |
| 1661 | 0U, |
| 1662 | 0U, |
| 1663 | 0U, |
| 1664 | 0U, |
| 1665 | 0U, |
| 1666 | 0U, |
| 1667 | 0U, |
| 1668 | 0U, |
| 1669 | 0U, |
| 1670 | 0U, |
| 1671 | 0U, |
| 1672 | 0U, |
| 1673 | 0U, |
| 1674 | 0U, |
| 1675 | 0U, |
| 1676 | 0U, |
| 1677 | 0U, |
| 1678 | 0U, |
| 1679 | 0U, |
| 1680 | 0U, |
| 1681 | 0U, |
| 1682 | 0U, |
| 1683 | 0U, |
| 1684 | 0U, |
| 1685 | 0U, |
| 1686 | 0U, |
| 1687 | 0U, |
| 1688 | 0U, |
| 1689 | 0U, |
| 1690 | 0U, |
| 1691 | 0U, |
| 1692 | 0U, |
| 1693 | 0U, |
| 1694 | 0U, |
| 1695 | 0U, |
| 1696 | 0U, |
| 1697 | 0U, |
| 1698 | 0U, |
| 1699 | 0U, |
| 1700 | 0U, |
| 1701 | 0U, |
| 1702 | 0U, |
| 1703 | 0U, |
| 1704 | 0U, |
| 1705 | 0U, |
| 1706 | 0U, |
| 1707 | 0U, |
| 1708 | 0U, |
| 1709 | 0U, |
| 1710 | 0U, |
| 1711 | 0U, |
| 1712 | 0U, |
| 1713 | 0U, |
| 1714 | 0U, |
| 1715 | 0U, |
| 1716 | 0U, |
| 1717 | 0U, |
| 1718 | 0U, |
| 1719 | 0U, |
| 1720 | 0U, |
| 1721 | 0U, |
| 1722 | 0U, |
| 1723 | 0U, |
| 1724 | 0U, |
| 1725 | 0U, |
| 1726 | 0U, |
| 1727 | 0U, |
| 1728 | 0U, |
| 1729 | 0U, |
| 1730 | 0U, |
| 1731 | 0U, |
| 1732 | 0U, |
| 1733 | 0U, |
| 1734 | 0U, |
| 1735 | 0U, |
| 1736 | 0U, |
| 1737 | 0U, |
| 1738 | 0U, |
| 1739 | 0U, |
| 1740 | 0U, |
| 1741 | 0U, |
| 1742 | 0U, |
| 1743 | 0U, |
| 1744 | 0U, |
| 1745 | 0U, |
| 1746 | 0U, |
| 1747 | 0U, |
| 1748 | 3U, |
| 1749 | 2U, |
| 1750 | 3U, |
| 1751 | 2U, |
| 1752 | 3U, |
| 1753 | 2U, |
| 1754 | 3U, |
| 1755 | 2U, |
| 1756 | 3U, |
| 1757 | 2U, |
| 1758 | 3U, |
| 1759 | 2U, |
| 1760 | 3U, |
| 1761 | 2U, |
| 1762 | 3U, |
| 1763 | 2U, |
| 1764 | 3U, |
| 1765 | 2U, |
| 1766 | 3U, |
| 1767 | 2U, |
| 1768 | 3U, |
| 1769 | 2U, |
| 1770 | 3U, |
| 1771 | 2U, |
| 1772 | 3U, |
| 1773 | 2U, |
| 1774 | 3U, |
| 1775 | 2U, |
| 1776 | 3U, |
| 1777 | 2U, |
| 1778 | 3U, |
| 1779 | 2U, |
| 1780 | 3U, |
| 1781 | 2U, |
| 1782 | 3U, |
| 1783 | 2U, |
| 1784 | 3U, |
| 1785 | 2U, |
| 1786 | 3U, |
| 1787 | 2U, |
| 1788 | 3U, |
| 1789 | 2U, |
| 1790 | 3U, |
| 1791 | 2U, |
| 1792 | 3U, |
| 1793 | 2U, |
| 1794 | 3U, |
| 1795 | 2U, |
| 1796 | 3U, |
| 1797 | 2U, |
| 1798 | 3U, |
| 1799 | 2U, |
| 1800 | 3U, |
| 1801 | 2U, |
| 1802 | 3U, |
| 1803 | 2U, |
| 1804 | 3U, |
| 1805 | 2U, |
| 1806 | 3U, |
| 1807 | 2U, |
| 1808 | 3U, |
| 1809 | 2U, |
| 1810 | 3U, |
| 1811 | 2U, |
| 1812 | 3U, |
| 1813 | 2U, |
| 1814 | 3U, |
| 1815 | 2U, |
| 1816 | 3U, |
| 1817 | 2U, |
| 1818 | 3U, |
| 1819 | 2U, |
| 1820 | 3U, |
| 1821 | 2U, |
| 1822 | 3U, |
| 1823 | 2U, |
| 1824 | 3U, |
| 1825 | 2U, |
| 1826 | 3U, |
| 1827 | 2U, |
| 1828 | 0U, |
| 1829 | 0U, |
| 1830 | 0U, |
| 1831 | 0U, |
| 1832 | 0U, |
| 1833 | 0U, |
| 1834 | 0U, |
| 1835 | 0U, |
| 1836 | 0U, |
| 1837 | 0U, |
| 1838 | 0U, |
| 1839 | 0U, |
| 1840 | 0U, |
| 1841 | 0U, |
| 1842 | 0U, |
| 1843 | 0U, |
| 1844 | 0U, |
| 1845 | 0U, |
| 1846 | 0U, |
| 1847 | 0U, |
| 1848 | 0U, |
| 1849 | 0U, |
| 1850 | 0U, |
| 1851 | 0U, |
| 1852 | 0U, |
| 1853 | 0U, |
| 1854 | 0U, |
| 1855 | 0U, |
| 1856 | 0U, |
| 1857 | 0U, |
| 1858 | 0U, |
| 1859 | 0U, |
| 1860 | 0U, |
| 1861 | 0U, |
| 1862 | 0U, |
| 1863 | 0U, |
| 1864 | 0U, |
| 1865 | 0U, |
| 1866 | 0U, |
| 1867 | 0U, |
| 1868 | 0U, |
| 1869 | 0U, |
| 1870 | 0U, |
| 1871 | 0U, |
| 1872 | 0U, |
| 1873 | 0U, |
| 1874 | 0U, |
| 1875 | 0U, |
| 1876 | 0U, |
| 1877 | 0U, |
| 1878 | 0U, |
| 1879 | 0U, |
| 1880 | 0U, |
| 1881 | 0U, |
| 1882 | 0U, |
| 1883 | 0U, |
| 1884 | 0U, |
| 1885 | 0U, |
| 1886 | 0U, |
| 1887 | 0U, |
| 1888 | 0U, |
| 1889 | 0U, |
| 1890 | 0U, |
| 1891 | 0U, |
| 1892 | 0U, |
| 1893 | 0U, |
| 1894 | 0U, |
| 1895 | 0U, |
| 1896 | 0U, |
| 1897 | 0U, |
| 1898 | 0U, |
| 1899 | 0U, |
| 1900 | 0U, |
| 1901 | 0U, |
| 1902 | 0U, |
| 1903 | 0U, |
| 1904 | 0U, |
| 1905 | 0U, |
| 1906 | 0U, |
| 1907 | 0U, |
| 1908 | 0U, |
| 1909 | 0U, |
| 1910 | 0U, |
| 1911 | 0U, |
| 1912 | 1U, |
| 1913 | 0U, |
| 1914 | 0U, |
| 1915 | 0U, |
| 1916 | 0U, |
| 1917 | 0U, |
| 1918 | 1U, |
| 1919 | 1U, |
| 1920 | 0U, |
| 1921 | 0U, |
| 1922 | 0U, |
| 1923 | 0U, |
| 1924 | 0U, |
| 1925 | 2U, |
| 1926 | 1U, |
| 1927 | 0U, |
| 1928 | 0U, |
| 1929 | 0U, |
| 1930 | 0U, |
| 1931 | 0U, |
| 1932 | 3U, |
| 1933 | 1U, |
| 1934 | 0U, |
| 1935 | 0U, |
| 1936 | 0U, |
| 1937 | 0U, |
| 1938 | 0U, |
| 1939 | 4U, |
| 1940 | 1U, |
| 1941 | 0U, |
| 1942 | 0U, |
| 1943 | 0U, |
| 1944 | 0U, |
| 1945 | 0U, |
| 1946 | 5U, |
| 1947 | 1U, |
| 1948 | 0U, |
| 1949 | 0U, |
| 1950 | 0U, |
| 1951 | 0U, |
| 1952 | 0U, |
| 1953 | 6U, |
| 1954 | 1U, |
| 1955 | 0U, |
| 1956 | 0U, |
| 1957 | 0U, |
| 1958 | 0U, |
| 1959 | 0U, |
| 1960 | 7U, |
| 1961 | 1U, |
| 1962 | 0U, |
| 1963 | 0U, |
| 1964 | 0U, |
| 1965 | 0U, |
| 1966 | 0U, |
| 1967 | 8U, |
| 1968 | 1U, |
| 1969 | 0U, |
| 1970 | 0U, |
| 1971 | 0U, |
| 1972 | 0U, |
| 1973 | 0U, |
| 1974 | 9U, |
| 1975 | 1U, |
| 1976 | 0U, |
| 1977 | 0U, |
| 1978 | 0U, |
| 1979 | 0U, |
| 1980 | 0U, |
| 1981 | 10U, |
| 1982 | 1U, |
| 1983 | 0U, |
| 1984 | 0U, |
| 1985 | 0U, |
| 1986 | 0U, |
| 1987 | 0U, |
| 1988 | 11U, |
| 1989 | 1U, |
| 1990 | 0U, |
| 1991 | 0U, |
| 1992 | 0U, |
| 1993 | 0U, |
| 1994 | 0U, |
| 1995 | 12U, |
| 1996 | 1U, |
| 1997 | 0U, |
| 1998 | 0U, |
| 1999 | 0U, |
| 2000 | 0U, |
| 2001 | 0U, |
| 2002 | 13U, |
| 2003 | 1U, |
| 2004 | 0U, |
| 2005 | 0U, |
| 2006 | 0U, |
| 2007 | 0U, |
| 2008 | 0U, |
| 2009 | 14U, |
| 2010 | 1U, |
| 2011 | 0U, |
| 2012 | 0U, |
| 2013 | 0U, |
| 2014 | 0U, |
| 2015 | 0U, |
| 2016 | 15U, |
| 2017 | 1U, |
| 2018 | 0U, |
| 2019 | 0U, |
| 2020 | 0U, |
| 2021 | 0U, |
| 2022 | 0U, |
| 2023 | 16U, |
| 2024 | 1U, |
| 2025 | 0U, |
| 2026 | 0U, |
| 2027 | 0U, |
| 2028 | 0U, |
| 2029 | 0U, |
| 2030 | 17U, |
| 2031 | 1U, |
| 2032 | 0U, |
| 2033 | 0U, |
| 2034 | 0U, |
| 2035 | 0U, |
| 2036 | 0U, |
| 2037 | 18U, |
| 2038 | 1U, |
| 2039 | 0U, |
| 2040 | 0U, |
| 2041 | 0U, |
| 2042 | 0U, |
| 2043 | 0U, |
| 2044 | 19U, |
| 2045 | 1U, |
| 2046 | 0U, |
| 2047 | 0U, |
| 2048 | 0U, |
| 2049 | 0U, |
| 2050 | 0U, |
| 2051 | 20U, |
| 2052 | 1U, |
| 2053 | 0U, |
| 2054 | 0U, |
| 2055 | 0U, |
| 2056 | 0U, |
| 2057 | 0U, |
| 2058 | 21U, |
| 2059 | 1U, |
| 2060 | 0U, |
| 2061 | 0U, |
| 2062 | 0U, |
| 2063 | 0U, |
| 2064 | 0U, |
| 2065 | 22U, |
| 2066 | 1U, |
| 2067 | 0U, |
| 2068 | 0U, |
| 2069 | 0U, |
| 2070 | 0U, |
| 2071 | 0U, |
| 2072 | 23U, |
| 2073 | 1U, |
| 2074 | 0U, |
| 2075 | 0U, |
| 2076 | 0U, |
| 2077 | 0U, |
| 2078 | 0U, |
| 2079 | 24U, |
| 2080 | 1U, |
| 2081 | 0U, |
| 2082 | 0U, |
| 2083 | 0U, |
| 2084 | 0U, |
| 2085 | 0U, |
| 2086 | 25U, |
| 2087 | 1U, |
| 2088 | 0U, |
| 2089 | 0U, |
| 2090 | 0U, |
| 2091 | 0U, |
| 2092 | 0U, |
| 2093 | 26U, |
| 2094 | 1U, |
| 2095 | 0U, |
| 2096 | 0U, |
| 2097 | 0U, |
| 2098 | 0U, |
| 2099 | 0U, |
| 2100 | 27U, |
| 2101 | 1U, |
| 2102 | 0U, |
| 2103 | 0U, |
| 2104 | 0U, |
| 2105 | 0U, |
| 2106 | 0U, |
| 2107 | 28U, |
| 2108 | 1U, |
| 2109 | 0U, |
| 2110 | 0U, |
| 2111 | 0U, |
| 2112 | 0U, |
| 2113 | 0U, |
| 2114 | 29U, |
| 2115 | 1U, |
| 2116 | 0U, |
| 2117 | 0U, |
| 2118 | 0U, |
| 2119 | 0U, |
| 2120 | 0U, |
| 2121 | 30U, |
| 2122 | 1U, |
| 2123 | 0U, |
| 2124 | 0U, |
| 2125 | 0U, |
| 2126 | 0U, |
| 2127 | 0U, |
| 2128 | 31U, |
| 2129 | 1U, |
| 2130 | 0U, |
| 2131 | 0U, |
| 2132 | 0U, |
| 2133 | 0U, |
| 2134 | 0U, |
| 2135 | 32U, |
| 2136 | 1U, |
| 2137 | 0U, |
| 2138 | 0U, |
| 2139 | 0U, |
| 2140 | 0U, |
| 2141 | 0U, |
| 2142 | 33U, |
| 2143 | 1U, |
| 2144 | 0U, |
| 2145 | 0U, |
| 2146 | 0U, |
| 2147 | 0U, |
| 2148 | 0U, |
| 2149 | 34U, |
| 2150 | 1U, |
| 2151 | 0U, |
| 2152 | 0U, |
| 2153 | 0U, |
| 2154 | 0U, |
| 2155 | 0U, |
| 2156 | 35U, |
| 2157 | 1U, |
| 2158 | 0U, |
| 2159 | 0U, |
| 2160 | 0U, |
| 2161 | 0U, |
| 2162 | 0U, |
| 2163 | 36U, |
| 2164 | 1U, |
| 2165 | 0U, |
| 2166 | 0U, |
| 2167 | 0U, |
| 2168 | 0U, |
| 2169 | 0U, |
| 2170 | 37U, |
| 2171 | 1U, |
| 2172 | 0U, |
| 2173 | 0U, |
| 2174 | 0U, |
| 2175 | 0U, |
| 2176 | 0U, |
| 2177 | 38U, |
| 2178 | 1U, |
| 2179 | 0U, |
| 2180 | 0U, |
| 2181 | 0U, |
| 2182 | 0U, |
| 2183 | 0U, |
| 2184 | 39U, |
| 2185 | 1U, |
| 2186 | 0U, |
| 2187 | 0U, |
| 2188 | 0U, |
| 2189 | 0U, |
| 2190 | 0U, |
| 2191 | 0U, |
| 2192 | 0U, |
| 2193 | 0U, |
| 2194 | 0U, |
| 2195 | 0U, |
| 2196 | 0U, |
| 2197 | 0U, |
| 2198 | 0U, |
| 2199 | 0U, |
| 2200 | 0U, |
| 2201 | 1U, |
| 2202 | 0U, |
| 2203 | 0U, |
| 2204 | 0U, |
| 2205 | 0U, |
| 2206 | 0U, |
| 2207 | 1U, |
| 2208 | 1U, |
| 2209 | 0U, |
| 2210 | 0U, |
| 2211 | 0U, |
| 2212 | 0U, |
| 2213 | 0U, |
| 2214 | 2U, |
| 2215 | 1U, |
| 2216 | 0U, |
| 2217 | 0U, |
| 2218 | 0U, |
| 2219 | 0U, |
| 2220 | 0U, |
| 2221 | 3U, |
| 2222 | 1U, |
| 2223 | 0U, |
| 2224 | 0U, |
| 2225 | 0U, |
| 2226 | 0U, |
| 2227 | 0U, |
| 2228 | 4U, |
| 2229 | 1U, |
| 2230 | 0U, |
| 2231 | 0U, |
| 2232 | 0U, |
| 2233 | 0U, |
| 2234 | 0U, |
| 2235 | 5U, |
| 2236 | 1U, |
| 2237 | 0U, |
| 2238 | 0U, |
| 2239 | 0U, |
| 2240 | 0U, |
| 2241 | 0U, |
| 2242 | 6U, |
| 2243 | 1U, |
| 2244 | 0U, |
| 2245 | 0U, |
| 2246 | 0U, |
| 2247 | 0U, |
| 2248 | 0U, |
| 2249 | 7U, |
| 2250 | 1U, |
| 2251 | 0U, |
| 2252 | 0U, |
| 2253 | 0U, |
| 2254 | 0U, |
| 2255 | 0U, |
| 2256 | 8U, |
| 2257 | 1U, |
| 2258 | 0U, |
| 2259 | 0U, |
| 2260 | 0U, |
| 2261 | 0U, |
| 2262 | 0U, |
| 2263 | 9U, |
| 2264 | 1U, |
| 2265 | 0U, |
| 2266 | 0U, |
| 2267 | 0U, |
| 2268 | 0U, |
| 2269 | 0U, |
| 2270 | 10U, |
| 2271 | 1U, |
| 2272 | 0U, |
| 2273 | 0U, |
| 2274 | 0U, |
| 2275 | 0U, |
| 2276 | 0U, |
| 2277 | 11U, |
| 2278 | 1U, |
| 2279 | 0U, |
| 2280 | 0U, |
| 2281 | 0U, |
| 2282 | 0U, |
| 2283 | 0U, |
| 2284 | 12U, |
| 2285 | 1U, |
| 2286 | 0U, |
| 2287 | 0U, |
| 2288 | 0U, |
| 2289 | 0U, |
| 2290 | 0U, |
| 2291 | 13U, |
| 2292 | 1U, |
| 2293 | 0U, |
| 2294 | 0U, |
| 2295 | 0U, |
| 2296 | 0U, |
| 2297 | 0U, |
| 2298 | 14U, |
| 2299 | 1U, |
| 2300 | 0U, |
| 2301 | 0U, |
| 2302 | 0U, |
| 2303 | 0U, |
| 2304 | 0U, |
| 2305 | 15U, |
| 2306 | 1U, |
| 2307 | 0U, |
| 2308 | 0U, |
| 2309 | 0U, |
| 2310 | 0U, |
| 2311 | 0U, |
| 2312 | 16U, |
| 2313 | 1U, |
| 2314 | 0U, |
| 2315 | 0U, |
| 2316 | 0U, |
| 2317 | 0U, |
| 2318 | 0U, |
| 2319 | 17U, |
| 2320 | 1U, |
| 2321 | 0U, |
| 2322 | 0U, |
| 2323 | 0U, |
| 2324 | 0U, |
| 2325 | 0U, |
| 2326 | 18U, |
| 2327 | 1U, |
| 2328 | 0U, |
| 2329 | 0U, |
| 2330 | 0U, |
| 2331 | 0U, |
| 2332 | 0U, |
| 2333 | 19U, |
| 2334 | 1U, |
| 2335 | 0U, |
| 2336 | 0U, |
| 2337 | 0U, |
| 2338 | 0U, |
| 2339 | 0U, |
| 2340 | 20U, |
| 2341 | 1U, |
| 2342 | 0U, |
| 2343 | 0U, |
| 2344 | 0U, |
| 2345 | 0U, |
| 2346 | 0U, |
| 2347 | 21U, |
| 2348 | 1U, |
| 2349 | 0U, |
| 2350 | 0U, |
| 2351 | 0U, |
| 2352 | 0U, |
| 2353 | 0U, |
| 2354 | 22U, |
| 2355 | 1U, |
| 2356 | 0U, |
| 2357 | 0U, |
| 2358 | 0U, |
| 2359 | 0U, |
| 2360 | 0U, |
| 2361 | 23U, |
| 2362 | 1U, |
| 2363 | 0U, |
| 2364 | 0U, |
| 2365 | 0U, |
| 2366 | 0U, |
| 2367 | 0U, |
| 2368 | 24U, |
| 2369 | 1U, |
| 2370 | 0U, |
| 2371 | 0U, |
| 2372 | 0U, |
| 2373 | 0U, |
| 2374 | 0U, |
| 2375 | 25U, |
| 2376 | 1U, |
| 2377 | 0U, |
| 2378 | 0U, |
| 2379 | 0U, |
| 2380 | 0U, |
| 2381 | 0U, |
| 2382 | 26U, |
| 2383 | 1U, |
| 2384 | 0U, |
| 2385 | 0U, |
| 2386 | 0U, |
| 2387 | 0U, |
| 2388 | 0U, |
| 2389 | 27U, |
| 2390 | 1U, |
| 2391 | 0U, |
| 2392 | 0U, |
| 2393 | 0U, |
| 2394 | 0U, |
| 2395 | 0U, |
| 2396 | 28U, |
| 2397 | 1U, |
| 2398 | 0U, |
| 2399 | 0U, |
| 2400 | 0U, |
| 2401 | 0U, |
| 2402 | 0U, |
| 2403 | 29U, |
| 2404 | 1U, |
| 2405 | 0U, |
| 2406 | 0U, |
| 2407 | 0U, |
| 2408 | 0U, |
| 2409 | 0U, |
| 2410 | 30U, |
| 2411 | 1U, |
| 2412 | 0U, |
| 2413 | 0U, |
| 2414 | 0U, |
| 2415 | 0U, |
| 2416 | 0U, |
| 2417 | 31U, |
| 2418 | 1U, |
| 2419 | 0U, |
| 2420 | 0U, |
| 2421 | 0U, |
| 2422 | 0U, |
| 2423 | 0U, |
| 2424 | 32U, |
| 2425 | 1U, |
| 2426 | 0U, |
| 2427 | 0U, |
| 2428 | 0U, |
| 2429 | 0U, |
| 2430 | 0U, |
| 2431 | 33U, |
| 2432 | 1U, |
| 2433 | 0U, |
| 2434 | 0U, |
| 2435 | 0U, |
| 2436 | 0U, |
| 2437 | 0U, |
| 2438 | 34U, |
| 2439 | 1U, |
| 2440 | 0U, |
| 2441 | 0U, |
| 2442 | 0U, |
| 2443 | 0U, |
| 2444 | 0U, |
| 2445 | 35U, |
| 2446 | 1U, |
| 2447 | 0U, |
| 2448 | 0U, |
| 2449 | 0U, |
| 2450 | 0U, |
| 2451 | 0U, |
| 2452 | 36U, |
| 2453 | 1U, |
| 2454 | 0U, |
| 2455 | 0U, |
| 2456 | 0U, |
| 2457 | 0U, |
| 2458 | 0U, |
| 2459 | 37U, |
| 2460 | 1U, |
| 2461 | 0U, |
| 2462 | 0U, |
| 2463 | 0U, |
| 2464 | 0U, |
| 2465 | 0U, |
| 2466 | 38U, |
| 2467 | 1U, |
| 2468 | 0U, |
| 2469 | 0U, |
| 2470 | 0U, |
| 2471 | 0U, |
| 2472 | 0U, |
| 2473 | 39U, |
| 2474 | 1U, |
| 2475 | 0U, |
| 2476 | 0U, |
| 2477 | 0U, |
| 2478 | 0U, |
| 2479 | 0U, |
| 2480 | 0U, |
| 2481 | 0U, |
| 2482 | 0U, |
| 2483 | 0U, |
| 2484 | 0U, |
| 2485 | 0U, |
| 2486 | 0U, |
| 2487 | 0U, |
| 2488 | 0U, |
| 2489 | 0U, |
| 2490 | 1U, |
| 2491 | 0U, |
| 2492 | 0U, |
| 2493 | 0U, |
| 2494 | 0U, |
| 2495 | 0U, |
| 2496 | 1U, |
| 2497 | 1U, |
| 2498 | 0U, |
| 2499 | 0U, |
| 2500 | 0U, |
| 2501 | 0U, |
| 2502 | 0U, |
| 2503 | 2U, |
| 2504 | 1U, |
| 2505 | 0U, |
| 2506 | 0U, |
| 2507 | 0U, |
| 2508 | 0U, |
| 2509 | 0U, |
| 2510 | 3U, |
| 2511 | 1U, |
| 2512 | 0U, |
| 2513 | 0U, |
| 2514 | 0U, |
| 2515 | 0U, |
| 2516 | 0U, |
| 2517 | 4U, |
| 2518 | 1U, |
| 2519 | 0U, |
| 2520 | 0U, |
| 2521 | 0U, |
| 2522 | 0U, |
| 2523 | 0U, |
| 2524 | 5U, |
| 2525 | 1U, |
| 2526 | 0U, |
| 2527 | 0U, |
| 2528 | 0U, |
| 2529 | 0U, |
| 2530 | 0U, |
| 2531 | 6U, |
| 2532 | 1U, |
| 2533 | 0U, |
| 2534 | 0U, |
| 2535 | 0U, |
| 2536 | 0U, |
| 2537 | 0U, |
| 2538 | 7U, |
| 2539 | 1U, |
| 2540 | 0U, |
| 2541 | 0U, |
| 2542 | 0U, |
| 2543 | 0U, |
| 2544 | 0U, |
| 2545 | 8U, |
| 2546 | 1U, |
| 2547 | 0U, |
| 2548 | 0U, |
| 2549 | 0U, |
| 2550 | 0U, |
| 2551 | 0U, |
| 2552 | 9U, |
| 2553 | 1U, |
| 2554 | 0U, |
| 2555 | 0U, |
| 2556 | 0U, |
| 2557 | 0U, |
| 2558 | 0U, |
| 2559 | 10U, |
| 2560 | 1U, |
| 2561 | 0U, |
| 2562 | 0U, |
| 2563 | 0U, |
| 2564 | 0U, |
| 2565 | 0U, |
| 2566 | 11U, |
| 2567 | 1U, |
| 2568 | 0U, |
| 2569 | 0U, |
| 2570 | 0U, |
| 2571 | 0U, |
| 2572 | 0U, |
| 2573 | 12U, |
| 2574 | 1U, |
| 2575 | 0U, |
| 2576 | 0U, |
| 2577 | 0U, |
| 2578 | 0U, |
| 2579 | 0U, |
| 2580 | 13U, |
| 2581 | 1U, |
| 2582 | 0U, |
| 2583 | 0U, |
| 2584 | 0U, |
| 2585 | 0U, |
| 2586 | 0U, |
| 2587 | 14U, |
| 2588 | 1U, |
| 2589 | 0U, |
| 2590 | 0U, |
| 2591 | 0U, |
| 2592 | 0U, |
| 2593 | 0U, |
| 2594 | 15U, |
| 2595 | 1U, |
| 2596 | 0U, |
| 2597 | 0U, |
| 2598 | 0U, |
| 2599 | 0U, |
| 2600 | 0U, |
| 2601 | 16U, |
| 2602 | 1U, |
| 2603 | 0U, |
| 2604 | 0U, |
| 2605 | 0U, |
| 2606 | 0U, |
| 2607 | 0U, |
| 2608 | 17U, |
| 2609 | 1U, |
| 2610 | 0U, |
| 2611 | 0U, |
| 2612 | 0U, |
| 2613 | 0U, |
| 2614 | 0U, |
| 2615 | 18U, |
| 2616 | 1U, |
| 2617 | 0U, |
| 2618 | 0U, |
| 2619 | 0U, |
| 2620 | 0U, |
| 2621 | 0U, |
| 2622 | 19U, |
| 2623 | 1U, |
| 2624 | 0U, |
| 2625 | 0U, |
| 2626 | 0U, |
| 2627 | 0U, |
| 2628 | 0U, |
| 2629 | 20U, |
| 2630 | 1U, |
| 2631 | 0U, |
| 2632 | 0U, |
| 2633 | 0U, |
| 2634 | 0U, |
| 2635 | 0U, |
| 2636 | 21U, |
| 2637 | 1U, |
| 2638 | 0U, |
| 2639 | 0U, |
| 2640 | 0U, |
| 2641 | 0U, |
| 2642 | 0U, |
| 2643 | 22U, |
| 2644 | 1U, |
| 2645 | 0U, |
| 2646 | 0U, |
| 2647 | 0U, |
| 2648 | 0U, |
| 2649 | 0U, |
| 2650 | 23U, |
| 2651 | 1U, |
| 2652 | 0U, |
| 2653 | 0U, |
| 2654 | 0U, |
| 2655 | 0U, |
| 2656 | 0U, |
| 2657 | 24U, |
| 2658 | 1U, |
| 2659 | 0U, |
| 2660 | 0U, |
| 2661 | 0U, |
| 2662 | 0U, |
| 2663 | 0U, |
| 2664 | 25U, |
| 2665 | 1U, |
| 2666 | 0U, |
| 2667 | 0U, |
| 2668 | 0U, |
| 2669 | 0U, |
| 2670 | 0U, |
| 2671 | 26U, |
| 2672 | 1U, |
| 2673 | 0U, |
| 2674 | 0U, |
| 2675 | 0U, |
| 2676 | 0U, |
| 2677 | 0U, |
| 2678 | 27U, |
| 2679 | 1U, |
| 2680 | 0U, |
| 2681 | 0U, |
| 2682 | 0U, |
| 2683 | 0U, |
| 2684 | 0U, |
| 2685 | 28U, |
| 2686 | 1U, |
| 2687 | 0U, |
| 2688 | 0U, |
| 2689 | 0U, |
| 2690 | 0U, |
| 2691 | 0U, |
| 2692 | 29U, |
| 2693 | 1U, |
| 2694 | 0U, |
| 2695 | 0U, |
| 2696 | 0U, |
| 2697 | 0U, |
| 2698 | 0U, |
| 2699 | 30U, |
| 2700 | 1U, |
| 2701 | 0U, |
| 2702 | 0U, |
| 2703 | 0U, |
| 2704 | 0U, |
| 2705 | 0U, |
| 2706 | 31U, |
| 2707 | 1U, |
| 2708 | 0U, |
| 2709 | 0U, |
| 2710 | 0U, |
| 2711 | 0U, |
| 2712 | 0U, |
| 2713 | 32U, |
| 2714 | 1U, |
| 2715 | 0U, |
| 2716 | 0U, |
| 2717 | 0U, |
| 2718 | 0U, |
| 2719 | 0U, |
| 2720 | 33U, |
| 2721 | 1U, |
| 2722 | 0U, |
| 2723 | 0U, |
| 2724 | 0U, |
| 2725 | 0U, |
| 2726 | 0U, |
| 2727 | 34U, |
| 2728 | 1U, |
| 2729 | 0U, |
| 2730 | 0U, |
| 2731 | 0U, |
| 2732 | 0U, |
| 2733 | 0U, |
| 2734 | 35U, |
| 2735 | 1U, |
| 2736 | 0U, |
| 2737 | 0U, |
| 2738 | 0U, |
| 2739 | 0U, |
| 2740 | 0U, |
| 2741 | 36U, |
| 2742 | 1U, |
| 2743 | 0U, |
| 2744 | 0U, |
| 2745 | 0U, |
| 2746 | 0U, |
| 2747 | 0U, |
| 2748 | 37U, |
| 2749 | 1U, |
| 2750 | 0U, |
| 2751 | 0U, |
| 2752 | 0U, |
| 2753 | 0U, |
| 2754 | 0U, |
| 2755 | 38U, |
| 2756 | 1U, |
| 2757 | 0U, |
| 2758 | 0U, |
| 2759 | 0U, |
| 2760 | 0U, |
| 2761 | 0U, |
| 2762 | 39U, |
| 2763 | 1U, |
| 2764 | 0U, |
| 2765 | 0U, |
| 2766 | 0U, |
| 2767 | 0U, |
| 2768 | 0U, |
| 2769 | 0U, |
| 2770 | 0U, |
| 2771 | 0U, |
| 2772 | 0U, |
| 2773 | 0U, |
| 2774 | 0U, |
| 2775 | 0U, |
| 2776 | 0U, |
| 2777 | 0U, |
| 2778 | 0U, |
| 2779 | 1U, |
| 2780 | 0U, |
| 2781 | 0U, |
| 2782 | 0U, |
| 2783 | 0U, |
| 2784 | 0U, |
| 2785 | 1U, |
| 2786 | 1U, |
| 2787 | 0U, |
| 2788 | 0U, |
| 2789 | 0U, |
| 2790 | 0U, |
| 2791 | 0U, |
| 2792 | 2U, |
| 2793 | 1U, |
| 2794 | 0U, |
| 2795 | 0U, |
| 2796 | 0U, |
| 2797 | 0U, |
| 2798 | 0U, |
| 2799 | 3U, |
| 2800 | 1U, |
| 2801 | 0U, |
| 2802 | 0U, |
| 2803 | 0U, |
| 2804 | 0U, |
| 2805 | 0U, |
| 2806 | 4U, |
| 2807 | 1U, |
| 2808 | 0U, |
| 2809 | 0U, |
| 2810 | 0U, |
| 2811 | 0U, |
| 2812 | 0U, |
| 2813 | 5U, |
| 2814 | 1U, |
| 2815 | 0U, |
| 2816 | 0U, |
| 2817 | 0U, |
| 2818 | 0U, |
| 2819 | 0U, |
| 2820 | 6U, |
| 2821 | 1U, |
| 2822 | 0U, |
| 2823 | 0U, |
| 2824 | 0U, |
| 2825 | 0U, |
| 2826 | 0U, |
| 2827 | 7U, |
| 2828 | 1U, |
| 2829 | 0U, |
| 2830 | 0U, |
| 2831 | 0U, |
| 2832 | 0U, |
| 2833 | 0U, |
| 2834 | 8U, |
| 2835 | 1U, |
| 2836 | 0U, |
| 2837 | 0U, |
| 2838 | 0U, |
| 2839 | 0U, |
| 2840 | 0U, |
| 2841 | 9U, |
| 2842 | 1U, |
| 2843 | 0U, |
| 2844 | 0U, |
| 2845 | 0U, |
| 2846 | 0U, |
| 2847 | 0U, |
| 2848 | 10U, |
| 2849 | 1U, |
| 2850 | 0U, |
| 2851 | 0U, |
| 2852 | 0U, |
| 2853 | 0U, |
| 2854 | 0U, |
| 2855 | 11U, |
| 2856 | 1U, |
| 2857 | 0U, |
| 2858 | 0U, |
| 2859 | 0U, |
| 2860 | 0U, |
| 2861 | 0U, |
| 2862 | 12U, |
| 2863 | 1U, |
| 2864 | 0U, |
| 2865 | 0U, |
| 2866 | 0U, |
| 2867 | 0U, |
| 2868 | 0U, |
| 2869 | 13U, |
| 2870 | 1U, |
| 2871 | 0U, |
| 2872 | 0U, |
| 2873 | 0U, |
| 2874 | 0U, |
| 2875 | 0U, |
| 2876 | 14U, |
| 2877 | 1U, |
| 2878 | 0U, |
| 2879 | 0U, |
| 2880 | 0U, |
| 2881 | 0U, |
| 2882 | 0U, |
| 2883 | 15U, |
| 2884 | 1U, |
| 2885 | 0U, |
| 2886 | 0U, |
| 2887 | 0U, |
| 2888 | 0U, |
| 2889 | 0U, |
| 2890 | 16U, |
| 2891 | 1U, |
| 2892 | 0U, |
| 2893 | 0U, |
| 2894 | 0U, |
| 2895 | 0U, |
| 2896 | 0U, |
| 2897 | 17U, |
| 2898 | 1U, |
| 2899 | 0U, |
| 2900 | 0U, |
| 2901 | 0U, |
| 2902 | 0U, |
| 2903 | 0U, |
| 2904 | 18U, |
| 2905 | 1U, |
| 2906 | 0U, |
| 2907 | 0U, |
| 2908 | 0U, |
| 2909 | 0U, |
| 2910 | 0U, |
| 2911 | 19U, |
| 2912 | 1U, |
| 2913 | 0U, |
| 2914 | 0U, |
| 2915 | 0U, |
| 2916 | 0U, |
| 2917 | 0U, |
| 2918 | 20U, |
| 2919 | 1U, |
| 2920 | 0U, |
| 2921 | 0U, |
| 2922 | 0U, |
| 2923 | 0U, |
| 2924 | 0U, |
| 2925 | 21U, |
| 2926 | 1U, |
| 2927 | 0U, |
| 2928 | 0U, |
| 2929 | 0U, |
| 2930 | 0U, |
| 2931 | 0U, |
| 2932 | 22U, |
| 2933 | 1U, |
| 2934 | 0U, |
| 2935 | 0U, |
| 2936 | 0U, |
| 2937 | 0U, |
| 2938 | 0U, |
| 2939 | 23U, |
| 2940 | 1U, |
| 2941 | 0U, |
| 2942 | 0U, |
| 2943 | 0U, |
| 2944 | 0U, |
| 2945 | 0U, |
| 2946 | 24U, |
| 2947 | 1U, |
| 2948 | 0U, |
| 2949 | 0U, |
| 2950 | 0U, |
| 2951 | 0U, |
| 2952 | 0U, |
| 2953 | 25U, |
| 2954 | 1U, |
| 2955 | 0U, |
| 2956 | 0U, |
| 2957 | 0U, |
| 2958 | 0U, |
| 2959 | 0U, |
| 2960 | 26U, |
| 2961 | 1U, |
| 2962 | 0U, |
| 2963 | 0U, |
| 2964 | 0U, |
| 2965 | 0U, |
| 2966 | 0U, |
| 2967 | 27U, |
| 2968 | 1U, |
| 2969 | 0U, |
| 2970 | 0U, |
| 2971 | 0U, |
| 2972 | 0U, |
| 2973 | 0U, |
| 2974 | 28U, |
| 2975 | 1U, |
| 2976 | 0U, |
| 2977 | 0U, |
| 2978 | 0U, |
| 2979 | 0U, |
| 2980 | 0U, |
| 2981 | 29U, |
| 2982 | 1U, |
| 2983 | 0U, |
| 2984 | 0U, |
| 2985 | 0U, |
| 2986 | 0U, |
| 2987 | 0U, |
| 2988 | 30U, |
| 2989 | 1U, |
| 2990 | 0U, |
| 2991 | 0U, |
| 2992 | 0U, |
| 2993 | 0U, |
| 2994 | 0U, |
| 2995 | 31U, |
| 2996 | 1U, |
| 2997 | 0U, |
| 2998 | 0U, |
| 2999 | 0U, |
| 3000 | 0U, |
| 3001 | 0U, |
| 3002 | 32U, |
| 3003 | 1U, |
| 3004 | 0U, |
| 3005 | 0U, |
| 3006 | 0U, |
| 3007 | 0U, |
| 3008 | 0U, |
| 3009 | 33U, |
| 3010 | 1U, |
| 3011 | 0U, |
| 3012 | 0U, |
| 3013 | 0U, |
| 3014 | 0U, |
| 3015 | 0U, |
| 3016 | 34U, |
| 3017 | 1U, |
| 3018 | 0U, |
| 3019 | 0U, |
| 3020 | 0U, |
| 3021 | 0U, |
| 3022 | 0U, |
| 3023 | 35U, |
| 3024 | 1U, |
| 3025 | 0U, |
| 3026 | 0U, |
| 3027 | 0U, |
| 3028 | 0U, |
| 3029 | 0U, |
| 3030 | 36U, |
| 3031 | 1U, |
| 3032 | 0U, |
| 3033 | 0U, |
| 3034 | 0U, |
| 3035 | 0U, |
| 3036 | 0U, |
| 3037 | 37U, |
| 3038 | 1U, |
| 3039 | 0U, |
| 3040 | 0U, |
| 3041 | 0U, |
| 3042 | 0U, |
| 3043 | 0U, |
| 3044 | 38U, |
| 3045 | 1U, |
| 3046 | 0U, |
| 3047 | 0U, |
| 3048 | 0U, |
| 3049 | 0U, |
| 3050 | 0U, |
| 3051 | 39U, |
| 3052 | 1U, |
| 3053 | 0U, |
| 3054 | 0U, |
| 3055 | 0U, |
| 3056 | 0U, |
| 3057 | 0U, |
| 3058 | 0U, |
| 3059 | 0U, |
| 3060 | 0U, |
| 3061 | 0U, |
| 3062 | 0U, |
| 3063 | 0U, |
| 3064 | 0U, |
| 3065 | 0U, |
| 3066 | 0U, |
| 3067 | 0U, |
| 3068 | 1U, |
| 3069 | 0U, |
| 3070 | 1U, |
| 3071 | 2U, |
| 3072 | 3U, |
| 3073 | 0U, |
| 3074 | 0U, |
| 3075 | 0U, |
| 3076 | 0U, |
| 3077 | 0U, |
| 3078 | 1U, |
| 3079 | 0U, |
| 3080 | 0U, |
| 3081 | 0U, |
| 3082 | 0U, |
| 3083 | 2U, |
| 3084 | 0U, |
| 3085 | 0U, |
| 3086 | 0U, |
| 3087 | 0U, |
| 3088 | 3U, |
| 3089 | 0U, |
| 3090 | 0U, |
| 3091 | 0U, |
| 3092 | 0U, |
| 3093 | 4U, |
| 3094 | 0U, |
| 3095 | 0U, |
| 3096 | 0U, |
| 3097 | 0U, |
| 3098 | 5U, |
| 3099 | 0U, |
| 3100 | 0U, |
| 3101 | 0U, |
| 3102 | 0U, |
| 3103 | 6U, |
| 3104 | 0U, |
| 3105 | 0U, |
| 3106 | 0U, |
| 3107 | 0U, |
| 3108 | 7U, |
| 3109 | 0U, |
| 3110 | 0U, |
| 3111 | 0U, |
| 3112 | 0U, |
| 3113 | 8U, |
| 3114 | 0U, |
| 3115 | 0U, |
| 3116 | 0U, |
| 3117 | 0U, |
| 3118 | 9U, |
| 3119 | 0U, |
| 3120 | 0U, |
| 3121 | 0U, |
| 3122 | 0U, |
| 3123 | 10U, |
| 3124 | 0U, |
| 3125 | 0U, |
| 3126 | 0U, |
| 3127 | 0U, |
| 3128 | 11U, |
| 3129 | 0U, |
| 3130 | 0U, |
| 3131 | 0U, |
| 3132 | 0U, |
| 3133 | 12U, |
| 3134 | 0U, |
| 3135 | 0U, |
| 3136 | 0U, |
| 3137 | 0U, |
| 3138 | 13U, |
| 3139 | 0U, |
| 3140 | 0U, |
| 3141 | 0U, |
| 3142 | 0U, |
| 3143 | 14U, |
| 3144 | 0U, |
| 3145 | 0U, |
| 3146 | 0U, |
| 3147 | 0U, |
| 3148 | 15U, |
| 3149 | 0U, |
| 3150 | 0U, |
| 3151 | 0U, |
| 3152 | 0U, |
| 3153 | 16U, |
| 3154 | 0U, |
| 3155 | 0U, |
| 3156 | 0U, |
| 3157 | 0U, |
| 3158 | 17U, |
| 3159 | 0U, |
| 3160 | 0U, |
| 3161 | 0U, |
| 3162 | 0U, |
| 3163 | 18U, |
| 3164 | 0U, |
| 3165 | 0U, |
| 3166 | 0U, |
| 3167 | 0U, |
| 3168 | 19U, |
| 3169 | 0U, |
| 3170 | 0U, |
| 3171 | 0U, |
| 3172 | 0U, |
| 3173 | 20U, |
| 3174 | 0U, |
| 3175 | 0U, |
| 3176 | 0U, |
| 3177 | 0U, |
| 3178 | 21U, |
| 3179 | 0U, |
| 3180 | 0U, |
| 3181 | 0U, |
| 3182 | 0U, |
| 3183 | 22U, |
| 3184 | 0U, |
| 3185 | 0U, |
| 3186 | 0U, |
| 3187 | 0U, |
| 3188 | 23U, |
| 3189 | 0U, |
| 3190 | 0U, |
| 3191 | 0U, |
| 3192 | 0U, |
| 3193 | 24U, |
| 3194 | 0U, |
| 3195 | 0U, |
| 3196 | 0U, |
| 3197 | 0U, |
| 3198 | 25U, |
| 3199 | 0U, |
| 3200 | 0U, |
| 3201 | 0U, |
| 3202 | 0U, |
| 3203 | 26U, |
| 3204 | 0U, |
| 3205 | 0U, |
| 3206 | 0U, |
| 3207 | 0U, |
| 3208 | 27U, |
| 3209 | 0U, |
| 3210 | 0U, |
| 3211 | 0U, |
| 3212 | 0U, |
| 3213 | 28U, |
| 3214 | 0U, |
| 3215 | 0U, |
| 3216 | 0U, |
| 3217 | 0U, |
| 3218 | 29U, |
| 3219 | 0U, |
| 3220 | 0U, |
| 3221 | 0U, |
| 3222 | 0U, |
| 3223 | 30U, |
| 3224 | 0U, |
| 3225 | 0U, |
| 3226 | 0U, |
| 3227 | 0U, |
| 3228 | 31U, |
| 3229 | 0U, |
| 3230 | 0U, |
| 3231 | 0U, |
| 3232 | 0U, |
| 3233 | 32U, |
| 3234 | 0U, |
| 3235 | 0U, |
| 3236 | 0U, |
| 3237 | 0U, |
| 3238 | 33U, |
| 3239 | 0U, |
| 3240 | 0U, |
| 3241 | 0U, |
| 3242 | 0U, |
| 3243 | 34U, |
| 3244 | 0U, |
| 3245 | 0U, |
| 3246 | 0U, |
| 3247 | 0U, |
| 3248 | 35U, |
| 3249 | 0U, |
| 3250 | 0U, |
| 3251 | 0U, |
| 3252 | 0U, |
| 3253 | 36U, |
| 3254 | 0U, |
| 3255 | 0U, |
| 3256 | 0U, |
| 3257 | 0U, |
| 3258 | 37U, |
| 3259 | 0U, |
| 3260 | 0U, |
| 3261 | 0U, |
| 3262 | 0U, |
| 3263 | 38U, |
| 3264 | 0U, |
| 3265 | 0U, |
| 3266 | 0U, |
| 3267 | 0U, |
| 3268 | 39U, |
| 3269 | 0U, |
| 3270 | 0U, |
| 3271 | 0U, |
| 3272 | 0U, |
| 3273 | 40U, |
| 3274 | 0U, |
| 3275 | 0U, |
| 3276 | 0U |
| 3277 | }; |
| 3278 | |
| 3279 | MdlrefDW_fusionAlg_T fusionAlg_MdlrefDW; |
| 3280 | |
| 3281 | /* Block signals (default storage) */ |
| 3282 | B_fusionAlg_c_T fusionAlg_B; |
| 3283 | |
| 3284 | /* Start for referenced model: 'fusionAlg' */ |
| 3285 | void fusionAlg_Start(void) |
| 3286 | { |
| 3287 | /* Start for S-Function (funsionAlg_sfun): '<S4>/FusionAlg' incorporates: |
| 3288 | * Constant: '<S4>/Constant' |
| 3289 | */ |
| 3290 | |
| 3291 | /* S-Function Block: <S4>/FusionAlg */ |
| 3292 | funsionAlg_sfun_Start_wrapper(); |
| 3293 | } |
| 3294 | |
| 3295 | /* Output and update for referenced model: 'fusionAlg' */ |
| 3296 | void fusionAlg(const real32_T *rtu_Radar410_Info_st_x50_20_Obj, const real32_T |
| 3297 | *rtu_Radar410_Info_st_x50_20_O_g, const real32_T |
| 3298 | *rtu_Radar410_Info_st_x50_20_O_c, const real32_T |
| 3299 | *rtu_Radar410_Info_st_x50_20_O_e, const real32_T |
| 3300 | *rtu_Radar410_Info_st_x50_20_O_n, const real32_T |
| 3301 | *rtu_Radar410_Info_st_x50_20_O_f, const real32_T |
| 3302 | *rtu_Radar410_Info_st_x50_20_O_k, const real32_T |
| 3303 | *rtu_Radar410_Info_st_x50_20_O_h, const real32_T |
| 3304 | *rtu_Radar410_Info_st_x50_20__kw, const real32_T |
| 3305 | *rtu_Radar410_Info_st_x50_20__ka, const real32_T |
| 3306 | *rtu_Radar410_Info_st_x50_20_kaa, const real32_T |
| 3307 | *rtu_Radar410_Info_st_x50_20__el, const real32_T |
| 3308 | *rtu_Radar410_Info_st_x50_20__cj, const real32_T |
| 3309 | *rtu_Radar410_Info_st_x50_20__ez, const real32_T |
| 3310 | *rtu_Radar410_Info_st_x50_20_O_o, const real32_T |
| 3311 | *rtu_Radar410_Info_st_x50_20_O_p, const real32_T |
| 3312 | *rtu_Radar410_Info_st_x51_21_Obj, const real32_T |
| 3313 | *rtu_Radar410_Info_st_x51_21_O_d, const real32_T |
| 3314 | *rtu_Radar410_Info_st_x51_21_O_g, const real32_T |
| 3315 | *rtu_Radar410_Info_st_x51_21_O_m, const real32_T |
| 3316 | *rtu_Radar410_Info_st_x51_21_O_p, const real32_T |
| 3317 | *rtu_Radar410_Info_st_x51_21_O_i, const real32_T |
| 3318 | *rtu_Radar410_Info_st_x51_21__pr, const real32_T |
| 3319 | *rtu_Radar410_Info_st_x51_21__pe, const real32_T |
| 3320 | *rtu_Radar410_Info_st_x51_21_O_o, const real32_T |
| 3321 | *rtu_Radar410_Info_st_x51_21_O_e, const real32_T |
| 3322 | *rtu_Radar410_Info_st_x51_21__mc, const real32_T |
| 3323 | *rtu_Radar410_Info_st_x51_21_O_j, const real32_T |
| 3324 | *rtu_Radar410_Info_st_x51_21__po, const real32_T |
| 3325 | *rtu_Radar410_Info_st_x51_21__m3, const real32_T |
| 3326 | *rtu_Radar410_Info_st_x51_21__p2, const real32_T |
| 3327 | *rtu_Radar410_Info_st_x51_21__i3, const real32_T |
| 3328 | *rtu_Radar410_Info_st_x52_22_Obj, const real32_T |
| 3329 | *rtu_Radar410_Info_st_x52_22_O_h, const real32_T |
| 3330 | *rtu_Radar410_Info_st_x52_22_O_b, const real32_T |
| 3331 | *rtu_Radar410_Info_st_x52_22_O_n, const real32_T |
| 3332 | *rtu_Radar410_Info_st_x52_22_O_g, const real32_T |
| 3333 | *rtu_Radar410_Info_st_x52_22__go, const real32_T |
| 3334 | *rtu_Radar410_Info_st_x52_22_O_e, const real32_T |
| 3335 | *rtu_Radar410_Info_st_x52_22_O_k, const real32_T |
| 3336 | *rtu_Radar410_Info_st_x52_22__bn, const real32_T |
| 3337 | *rtu_Radar410_Info_st_x52_22_O_c, const real32_T |
| 3338 | *rtu_Radar410_Info_st_x52_22_O_l, const real32_T |
| 3339 | *rtu_Radar410_Info_st_x52_22_O_p, const real32_T |
| 3340 | *rtu_Radar410_Info_st_x52_22__py, const real32_T |
| 3341 | *rtu_Radar410_Info_st_x52_22__en, const real32_T |
| 3342 | *rtu_Radar410_Info_st_x52_22__px, const real32_T |
| 3343 | *rtu_Radar410_Info_st_x52_22_O_m, const real32_T |
| 3344 | *rtu_Radar410_Info_st_x53_23_Obj, const real32_T |
| 3345 | *rtu_Radar410_Info_st_x53_23_O_f, const real32_T |
| 3346 | *rtu_Radar410_Info_st_x53_23_O_d, const real32_T |
| 3347 | *rtu_Radar410_Info_st_x53_23_O_m, const real32_T |
| 3348 | *rtu_Radar410_Info_st_x53_23_O_h, const real32_T |
| 3349 | *rtu_Radar410_Info_st_x53_23__hz, const real32_T |
| 3350 | *rtu_Radar410_Info_st_x53_23__h2, const real32_T |
| 3351 | *rtu_Radar410_Info_st_x53_23__hs, const real32_T |
| 3352 | *rtu_Radar410_Info_st_x53_23_O_i, const real32_T |
| 3353 | *rtu_Radar410_Info_st_x53_23__h5, const real32_T |
| 3354 | *rtu_Radar410_Info_st_x53_23__h1, const real32_T |
| 3355 | *rtu_Radar410_Info_st_x53_23__ig, const real32_T |
| 3356 | *rtu_Radar410_Info_st_x53_23__dz, const real32_T |
| 3357 | *rtu_Radar410_Info_st_x53_23_O_a, const real32_T |
| 3358 | *rtu_Radar410_Info_st_x53_23__id, const real32_T |
| 3359 | *rtu_Radar410_Info_st_x53_23_O_b, const real32_T |
| 3360 | *rtu_Radar410_Info_st_x54_24_Obj, const real32_T |
| 3361 | *rtu_Radar410_Info_st_x54_24_O_j, const real32_T |
| 3362 | *rtu_Radar410_Info_st_x54_24_O_l, const real32_T |
| 3363 | *rtu_Radar410_Info_st_x54_24_O_e, const real32_T |
| 3364 | *rtu_Radar410_Info_st_x54_24__le, const real32_T |
| 3365 | *rtu_Radar410_Info_st_x54_24_O_h, const real32_T |
| 3366 | *rtu_Radar410_Info_st_x54_24__hc, const real32_T |
| 3367 | *rtu_Radar410_Info_st_x54_24__hl, const real32_T |
| 3368 | *rtu_Radar410_Info_st_x54_24__ef, const real32_T |
| 3369 | *rtu_Radar410_Info_st_x54_24__h2, const real32_T |
| 3370 | *rtu_Radar410_Info_st_x54_24_O_b, const real32_T |
| 3371 | *rtu_Radar410_Info_st_x54_24_O_a, const real32_T |
| 3372 | *rtu_Radar410_Info_st_x54_24_O_k, const real32_T |
| 3373 | *rtu_Radar410_Info_st_x54_24_O_i, const real32_T |
| 3374 | *rtu_Radar410_Info_st_x54_24__ba, const real32_T |
| 3375 | *rtu_Radar410_Info_st_x54_24__ir, const real32_T |
| 3376 | *rtu_Radar410_Info_st_x55_25_Obj, const real32_T |
| 3377 | *rtu_Radar410_Info_st_x55_25_O_d, const real32_T |
| 3378 | *rtu_Radar410_Info_st_x55_25_O_g, const real32_T |
| 3379 | *rtu_Radar410_Info_st_x55_25_O_i, const real32_T |
| 3380 | *rtu_Radar410_Info_st_x55_25_O_h, const real32_T |
| 3381 | *rtu_Radar410_Info_st_x55_25_O_b, const real32_T |
| 3382 | *rtu_Radar410_Info_st_x55_25_O_l, const real32_T |
| 3383 | *rtu_Radar410_Info_st_x55_25__go, const real32_T |
| 3384 | *rtu_Radar410_Info_st_x55_25_O_f, const real32_T |
| 3385 | *rtu_Radar410_Info_st_x55_25_O_a, const real32_T |
| 3386 | *rtu_Radar410_Info_st_x55_25__gz, const real32_T |
| 3387 | *rtu_Radar410_Info_st_x55_25_O_c, const real32_T |
| 3388 | *rtu_Radar410_Info_st_x55_25__gh, const real32_T |
| 3389 | *rtu_Radar410_Info_st_x55_25_O_e, const real32_T |
| 3390 | *rtu_Radar410_Info_st_x55_25__lr, const real32_T |
| 3391 | *rtu_Radar410_Info_st_x55_25__l2, const real32_T |
| 3392 | *rtu_Radar410_Info_st_x56_26_Obj, const real32_T |
| 3393 | *rtu_Radar410_Info_st_x56_26_O_e, const real32_T |
| 3394 | *rtu_Radar410_Info_st_x56_26_O_c, const real32_T |
| 3395 | *rtu_Radar410_Info_st_x56_26_O_g, const real32_T |
| 3396 | *rtu_Radar410_Info_st_x56_26_O_l, const real32_T |
| 3397 | *rtu_Radar410_Info_st_x56_26_O_b, const real32_T |
| 3398 | *rtu_Radar410_Info_st_x56_26_O_i, const real32_T |
| 3399 | *rtu_Radar410_Info_st_x56_26_O_a, const real32_T |
| 3400 | *rtu_Radar410_Info_st_x56_26_O_o, const real32_T |
| 3401 | *rtu_Radar410_Info_st_x56_26__iq, const real32_T |
| 3402 | *rtu_Radar410_Info_st_x56_26__ex, const real32_T |
| 3403 | *rtu_Radar410_Info_st_x56_26_O_d, const real32_T |
| 3404 | *rtu_Radar410_Info_st_x56_26__do, const real32_T |
| 3405 | *rtu_Radar410_Info_st_x56_26__lj, const real32_T |
| 3406 | *rtu_Radar410_Info_st_x56_26_O_k, const real32_T |
| 3407 | *rtu_Radar410_Info_st_x56_26_O_n, const real32_T |
| 3408 | *rtu_Radar410_Info_st_x57_27_Obj, const real32_T |
| 3409 | *rtu_Radar410_Info_st_x57_27_O_g, const real32_T |
| 3410 | *rtu_Radar410_Info_st_x57_27_O_m, const real32_T |
| 3411 | *rtu_Radar410_Info_st_x57_27_O_l, const real32_T |
| 3412 | *rtu_Radar410_Info_st_x57_27_O_a, const real32_T |
| 3413 | *rtu_Radar410_Info_st_x57_27_O_i, const real32_T |
| 3414 | *rtu_Radar410_Info_st_x57_27__iu, const real32_T |
| 3415 | *rtu_Radar410_Info_st_x57_27_O_n, const real32_T |
| 3416 | *rtu_Radar410_Info_st_x57_27__al, const real32_T |
| 3417 | *rtu_Radar410_Info_st_x57_27_O_o, const real32_T |
| 3418 | *rtu_Radar410_Info_st_x57_27__au, const real32_T |
| 3419 | *rtu_Radar410_Info_st_x57_27__lc, const real32_T |
| 3420 | *rtu_Radar410_Info_st_x57_27_O_e, const real32_T |
| 3421 | *rtu_Radar410_Info_st_x57_27_O_d, const real32_T |
| 3422 | *rtu_Radar410_Info_st_x57_27__ga, const real32_T |
| 3423 | *rtu_Radar410_Info_st_x57_27_O_h, const real32_T |
| 3424 | *rtu_Radar410_Info_st_x58_28_Obj, const real32_T |
| 3425 | *rtu_Radar410_Info_st_x58_28_O_c, const real32_T |
| 3426 | *rtu_Radar410_Info_st_x58_28_O_p, const real32_T |
| 3427 | *rtu_Radar410_Info_st_x58_28_O_n, const real32_T |
| 3428 | *rtu_Radar410_Info_st_x58_28_O_k, const real32_T |
| 3429 | *rtu_Radar410_Info_st_x58_28_O_b, const real32_T |
| 3430 | *rtu_Radar410_Info_st_x58_28_O_j, const real32_T |
| 3431 | *rtu_Radar410_Info_st_x58_28__cg, const real32_T |
| 3432 | *rtu_Radar410_Info_st_x58_28__kp, const real32_T |
| 3433 | *rtu_Radar410_Info_st_x58_28_O_m, const real32_T |
| 3434 | *rtu_Radar410_Info_st_x58_28__ba, const real32_T |
| 3435 | *rtu_Radar410_Info_st_x58_28__kd, const real32_T |
| 3436 | *rtu_Radar410_Info_st_x58_28_O_a, const real32_T |
| 3437 | *rtu_Radar410_Info_st_x58_28_O_d, const real32_T |
| 3438 | *rtu_Radar410_Info_st_x58_28_O_l, const real32_T |
| 3439 | *rtu_Radar410_Info_st_x58_28__cb, const real32_T |
| 3440 | *rtu_Radar410_Info_st_x59_29_Obj, const real32_T |
| 3441 | *rtu_Radar410_Info_st_x59_29_O_o, const real32_T |
| 3442 | *rtu_Radar410_Info_st_x59_29_O_m, const real32_T |
| 3443 | *rtu_Radar410_Info_st_x59_29_O_g, const real32_T |
| 3444 | *rtu_Radar410_Info_st_x59_29_O_b, const real32_T |
| 3445 | *rtu_Radar410_Info_st_x59_29_O_a, const real32_T |
| 3446 | *rtu_Radar410_Info_st_x59_29_O_n, const real32_T |
| 3447 | *rtu_Radar410_Info_st_x59_29__a1, const real32_T |
| 3448 | *rtu_Radar410_Info_st_x59_29_O_i, const real32_T |
| 3449 | *rtu_Radar410_Info_st_x59_29_O_d, const real32_T |
| 3450 | *rtu_Radar410_Info_st_x59_29__iz, const real32_T |
| 3451 | *rtu_Radar410_Info_st_x59_29__nl, const real32_T |
| 3452 | *rtu_Radar410_Info_st_x59_29__nw, const real32_T |
| 3453 | *rtu_Radar410_Info_st_x59_29_O_j, const real32_T |
| 3454 | *rtu_Radar410_Info_st_x59_29_O_k, const real32_T |
| 3455 | *rtu_Radar410_Info_st_x59_29__ac, const real32_T |
| 3456 | *rtu_Radar410_Info_st_x5A_2A_Obj, const real32_T |
| 3457 | *rtu_Radar410_Info_st_x5A_2A_O_k, const real32_T |
| 3458 | *rtu_Radar410_Info_st_x5A_2A_O_l, const real32_T |
| 3459 | *rtu_Radar410_Info_st_x5A_2A_O_d, const real32_T |
| 3460 | *rtu_Radar410_Info_st_x5A_2A_O_i, const real32_T |
| 3461 | *rtu_Radar410_Info_st_x5A_2A__dp, const real32_T |
| 3462 | *rtu_Radar410_Info_st_x5A_2A_O_p, const real32_T |
| 3463 | *rtu_Radar410_Info_st_x5A_2A_O_n, const real32_T |
| 3464 | *rtu_Radar410_Info_st_x5A_2A_O_a, const real32_T |
| 3465 | *rtu_Radar410_Info_st_x5A_2A_O_b, const real32_T |
| 3466 | *rtu_Radar410_Info_st_x5A_2A__nw, const real32_T |
| 3467 | *rtu_Radar410_Info_st_x5A_2A_O_j, const real32_T |
| 3468 | *rtu_Radar410_Info_st_x5A_2A__l5, const real32_T |
| 3469 | *rtu_Radar410_Info_st_x5A_2A__bg, const real32_T |
| 3470 | *rtu_Radar410_Info_st_x5A_2A__ai, const real32_T |
| 3471 | *rtu_Radar410_Info_st_x5A_2A__jl, const real32_T |
| 3472 | *rtu_Radar410_Info_st_x5B_2B_Obj, const real32_T |
| 3473 | *rtu_Radar410_Info_st_x5B_2B_O_f, const real32_T |
| 3474 | *rtu_Radar410_Info_st_x5B_2B_O_a, const real32_T |
| 3475 | *rtu_Radar410_Info_st_x5B_2B__aw, const real32_T |
| 3476 | *rtu_Radar410_Info_st_x5B_2B_O_e, const real32_T |
| 3477 | *rtu_Radar410_Info_st_x5B_2B_O_p, const real32_T |
| 3478 | *rtu_Radar410_Info_st_x5B_2B_O_b, const real32_T |
| 3479 | *rtu_Radar410_Info_st_x5B_2B_O_k, const real32_T |
| 3480 | *rtu_Radar410_Info_st_x5B_2B_O_h, const real32_T |
| 3481 | *rtu_Radar410_Info_st_x5B_2B__e5, const real32_T |
| 3482 | *rtu_Radar410_Info_st_x5B_2B_O_g, const real32_T |
| 3483 | *rtu_Radar410_Info_st_x5B_2B_O_d, const real32_T |
| 3484 | *rtu_Radar410_Info_st_x5B_2B__a0, const real32_T |
| 3485 | *rtu_Radar410_Info_st_x5B_2B_O_i, const real32_T |
| 3486 | *rtu_Radar410_Info_st_x5B_2B__iz, const real32_T |
| 3487 | *rtu_Radar410_Info_st_x5B_2B__f2, const real32_T |
| 3488 | *rtu_Radar410_Info_st_x5C_2C_Obj, const real32_T |
| 3489 | *rtu_Radar410_Info_st_x5C_2C_O_b, const real32_T |
| 3490 | *rtu_Radar410_Info_st_x5C_2C_O_h, const real32_T |
| 3491 | *rtu_Radar410_Info_st_x5C_2C_O_l, const real32_T |
| 3492 | *rtu_Radar410_Info_st_x5C_2C__la, const real32_T |
| 3493 | *rtu_Radar410_Info_st_x5C_2C_O_k, const real32_T |
| 3494 | *rtu_Radar410_Info_st_x5C_2C__lo, const real32_T |
| 3495 | *rtu_Radar410_Info_st_x5C_2C_O_g, const real32_T |
| 3496 | *rtu_Radar410_Info_st_x5C_2C__gm, const real32_T |
| 3497 | *rtu_Radar410_Info_st_x5C_2C_O_f, const real32_T |
| 3498 | *rtu_Radar410_Info_st_x5C_2C_O_o, const real32_T |
| 3499 | *rtu_Radar410_Info_st_x5C_2C_O_i, const real32_T |
| 3500 | *rtu_Radar410_Info_st_x5C_2C__fk, const real32_T |
| 3501 | *rtu_Radar410_Info_st_x5C_2C__i3, const real32_T |
| 3502 | *rtu_Radar410_Info_st_x5C_2C_O_a, const real32_T |
| 3503 | *rtu_Radar410_Info_st_x5C_2C__oq, const real32_T |
| 3504 | *rtu_Radar410_Info_st_x5D_2D_Obj, const real32_T |
| 3505 | *rtu_Radar410_Info_st_x5D_2D_O_e, const real32_T |
| 3506 | *rtu_Radar410_Info_st_x5D_2D_O_p, const real32_T |
| 3507 | *rtu_Radar410_Info_st_x5D_2D_O_o, const real32_T |
| 3508 | *rtu_Radar410_Info_st_x5D_2D_O_h, const real32_T |
| 3509 | *rtu_Radar410_Info_st_x5D_2D_O_n, const real32_T |
| 3510 | *rtu_Radar410_Info_st_x5D_2D__no, const real32_T |
| 3511 | *rtu_Radar410_Info_st_x5D_2D_O_c, const real32_T |
| 3512 | *rtu_Radar410_Info_st_x5D_2D__hf, const real32_T |
| 3513 | *rtu_Radar410_Info_st_x5D_2D__on, const real32_T |
| 3514 | *rtu_Radar410_Info_st_x5D_2D_O_j, const real32_T |
| 3515 | *rtu_Radar410_Info_st_x5D_2D_O_l, const real32_T |
| 3516 | *rtu_Radar410_Info_st_x5D_2D_O_g, const real32_T |
| 3517 | *rtu_Radar410_Info_st_x5D_2D__gg, const real32_T |
| 3518 | *rtu_Radar410_Info_st_x5D_2D_O_m, const real32_T |
| 3519 | *rtu_Radar410_Info_st_x5D_2D__hb, const real32_T |
| 3520 | *rtu_Radar410_Info_st_x5E_2E_Obj, const real32_T |
| 3521 | *rtu_Radar410_Info_st_x5E_2E_O_l, const real32_T |
| 3522 | *rtu_Radar410_Info_st_x5E_2E_O_g, const real32_T |
| 3523 | *rtu_Radar410_Info_st_x5E_2E__lx, const real32_T |
| 3524 | *rtu_Radar410_Info_st_x5E_2E_O_h, const real32_T |
| 3525 | *rtu_Radar410_Info_st_x5E_2E__lc, const real32_T |
| 3526 | *rtu_Radar410_Info_st_x5E_2E__gu, const real32_T |
| 3527 | *rtu_Radar410_Info_st_x5E_2E__gn, const real32_T |
| 3528 | *rtu_Radar410_Info_st_x5E_2E_O_m, const real32_T |
| 3529 | *rtu_Radar410_Info_st_x5E_2E_O_i, const real32_T |
| 3530 | *rtu_Radar410_Info_st_x5E_2E__if, const real32_T |
| 3531 | *rtu_Radar410_Info_st_x5E_2E__l3, const real32_T |
| 3532 | *rtu_Radar410_Info_st_x5E_2E__ie, const real32_T |
| 3533 | *rtu_Radar410_Info_st_x5E_2E_O_a, const real32_T |
| 3534 | *rtu_Radar410_Info_st_x5E_2E_O_c, const real32_T |
| 3535 | *rtu_Radar410_Info_st_x5E_2E_O_f, const real32_T |
| 3536 | *rtu_Radar410_Info_st_x5F_2F_Obj, const real32_T |
| 3537 | *rtu_Radar410_Info_st_x5F_2F_O_d, const real32_T |
| 3538 | *rtu_Radar410_Info_st_x5F_2F_O_g, const real32_T |
| 3539 | *rtu_Radar410_Info_st_x5F_2F_O_h, const real32_T |
| 3540 | *rtu_Radar410_Info_st_x5F_2F_O_f, const real32_T |
| 3541 | *rtu_Radar410_Info_st_x5F_2F_O_e, const real32_T |
| 3542 | *rtu_Radar410_Info_st_x5F_2F_O_n, const real32_T |
| 3543 | *rtu_Radar410_Info_st_x5F_2F__fw, const real32_T |
| 3544 | *rtu_Radar410_Info_st_x5F_2F_O_j, const real32_T |
| 3545 | *rtu_Radar410_Info_st_x5F_2F__ds, const real32_T |
| 3546 | *rtu_Radar410_Info_st_x5F_2F__hh, const real32_T |
| 3547 | *rtu_Radar410_Info_st_x5F_2F_O_o, const real32_T |
| 3548 | *rtu_Radar410_Info_st_x5F_2F__hw, const real32_T |
| 3549 | *rtu_Radar410_Info_st_x5F_2F_O_l, const real32_T |
| 3550 | *rtu_Radar410_Info_st_x5F_2F_O_c, const real32_T |
| 3551 | *rtu_Radar410_Info_st_x5F_2F__oa, const real32_T |
| 3552 | *rtu_Radar410_Info_st_x60_30_Obj, const real32_T |
| 3553 | *rtu_Radar410_Info_st_x60_30_O_k, const real32_T |
| 3554 | *rtu_Radar410_Info_st_x60_30_O_d, const real32_T |
| 3555 | *rtu_Radar410_Info_st_x60_30_O_f, const real32_T |
| 3556 | *rtu_Radar410_Info_st_x60_30_O_a, const real32_T |
| 3557 | *rtu_Radar410_Info_st_x60_30_O_g, const real32_T |
| 3558 | *rtu_Radar410_Info_st_x60_30__d4, const real32_T |
| 3559 | *rtu_Radar410_Info_st_x60_30_O_h, const real32_T |
| 3560 | *rtu_Radar410_Info_st_x60_30_O_l, const real32_T |
| 3561 | *rtu_Radar410_Info_st_x60_30_O_j, const real32_T |
| 3562 | *rtu_Radar410_Info_st_x60_30__jp, const real32_T |
| 3563 | *rtu_Radar410_Info_st_x60_30_O_e, const real32_T |
| 3564 | *rtu_Radar410_Info_st_x60_30_O_m, const real32_T |
| 3565 | *rtu_Radar410_Info_st_x60_30__ga, const real32_T |
| 3566 | *rtu_Radar410_Info_st_x60_30__j4, const real32_T |
| 3567 | *rtu_Radar410_Info_st_x60_30_O_p, const real32_T |
| 3568 | *rtu_Radar410_Info_st_x61_31_Obj, const real32_T |
| 3569 | *rtu_Radar410_Info_st_x61_31_O_i, const real32_T |
| 3570 | *rtu_Radar410_Info_st_x61_31_O_b, const real32_T |
| 3571 | *rtu_Radar410_Info_st_x61_31_O_l, const real32_T |
| 3572 | *rtu_Radar410_Info_st_x61_31_O_m, const real32_T |
| 3573 | *rtu_Radar410_Info_st_x61_31_O_f, const real32_T |
| 3574 | *rtu_Radar410_Info_st_x61_31__mk, const real32_T |
| 3575 | *rtu_Radar410_Info_st_x61_31_O_n, const real32_T |
| 3576 | *rtu_Radar410_Info_st_x61_31_O_k, const real32_T |
| 3577 | *rtu_Radar410_Info_st_x61_31_O_a, const real32_T |
| 3578 | *rtu_Radar410_Info_st_x61_31__bg, const real32_T |
| 3579 | *rtu_Radar410_Info_st_x61_31__ir, const real32_T |
| 3580 | *rtu_Radar410_Info_st_x61_31_O_d, const real32_T |
| 3581 | *rtu_Radar410_Info_st_x61_31_O_j, const real32_T |
| 3582 | *rtu_Radar410_Info_st_x61_31__mz, const real32_T |
| 3583 | *rtu_Radar410_Info_st_x61_31__dz, const real32_T |
| 3584 | *rtu_Radar410_Info_st_x62_32_Obj, const real32_T |
| 3585 | *rtu_Radar410_Info_st_x62_32_O_p, const real32_T |
| 3586 | *rtu_Radar410_Info_st_x62_32_O_j, const real32_T |
| 3587 | *rtu_Radar410_Info_st_x62_32__ja, const real32_T |
| 3588 | *rtu_Radar410_Info_st_x62_32_O_e, const real32_T |
| 3589 | *rtu_Radar410_Info_st_x62_32_O_d, const real32_T |
| 3590 | *rtu_Radar410_Info_st_x62_32_O_k, const real32_T |
| 3591 | *rtu_Radar410_Info_st_x62_32_O_o, const real32_T |
| 3592 | *rtu_Radar410_Info_st_x62_32__ku, const real32_T |
| 3593 | *rtu_Radar410_Info_st_x62_32_O_a, const real32_T |
| 3594 | *rtu_Radar410_Info_st_x62_32__jk, const real32_T |
| 3595 | *rtu_Radar410_Info_st_x62_32_O_m, const real32_T |
| 3596 | *rtu_Radar410_Info_st_x62_32_O_c, const real32_T |
| 3597 | *rtu_Radar410_Info_st_x62_32_O_l, const real32_T |
| 3598 | *rtu_Radar410_Info_st_x62_32__cz, const real32_T |
| 3599 | *rtu_Radar410_Info_st_x62_32_O_i, const real32_T |
| 3600 | *rtu_Radar410_Info_st_x63_33_Obj, const real32_T |
| 3601 | *rtu_Radar410_Info_st_x63_33_O_b, const real32_T |
| 3602 | *rtu_Radar410_Info_st_x63_33_O_k, const real32_T |
| 3603 | *rtu_Radar410_Info_st_x63_33_O_m, const real32_T |
| 3604 | *rtu_Radar410_Info_st_x63_33_O_i, const real32_T |
| 3605 | *rtu_Radar410_Info_st_x63_33_O_e, const real32_T |
| 3606 | *rtu_Radar410_Info_st_x63_33_O_p, const real32_T |
| 3607 | *rtu_Radar410_Info_st_x63_33_O_d, const real32_T |
| 3608 | *rtu_Radar410_Info_st_x63_33_O_j, const real32_T |
| 3609 | *rtu_Radar410_Info_st_x63_33__pi, const real32_T |
| 3610 | *rtu_Radar410_Info_st_x63_33_O_h, const real32_T |
| 3611 | *rtu_Radar410_Info_st_x63_33__hk, const real32_T |
| 3612 | *rtu_Radar410_Info_st_x63_33__k4, const real32_T |
| 3613 | *rtu_Radar410_Info_st_x63_33__kw, const real32_T |
| 3614 | *rtu_Radar410_Info_st_x63_33_O_n, const real32_T |
| 3615 | *rtu_Radar410_Info_st_x63_33__nh, const real32_T |
| 3616 | *rtu_Radar410_Info_st_x64_34_Obj, const real32_T |
| 3617 | *rtu_Radar410_Info_st_x64_34_O_n, const real32_T |
| 3618 | *rtu_Radar410_Info_st_x64_34_O_g, const real32_T |
| 3619 | *rtu_Radar410_Info_st_x64_34_O_o, const real32_T |
| 3620 | *rtu_Radar410_Info_st_x64_34__gh, const real32_T |
| 3621 | *rtu_Radar410_Info_st_x64_34_O_p, const real32_T |
| 3622 | *rtu_Radar410_Info_st_x64_34__gw, const real32_T |
| 3623 | *rtu_Radar410_Info_st_x64_34__go, const real32_T |
| 3624 | *rtu_Radar410_Info_st_x64_34_O_a, const real32_T |
| 3625 | *rtu_Radar410_Info_st_x64_34_O_l, const real32_T |
| 3626 | *rtu_Radar410_Info_st_x64_34_O_c, const real32_T |
| 3627 | *rtu_Radar410_Info_st_x64_34__nz, const real32_T |
| 3628 | *rtu_Radar410_Info_st_x64_34__av, const real32_T |
| 3629 | *rtu_Radar410_Info_st_x64_34_O_b, const real32_T |
| 3630 | *rtu_Radar410_Info_st_x64_34_O_e, const real32_T |
| 3631 | *rtu_Radar410_Info_st_x64_34_O_d, const real32_T |
| 3632 | *rtu_Radar410_Info_st_x65_35_Obj, const real32_T |
| 3633 | *rtu_Radar410_Info_st_x65_35_O_k, const real32_T |
| 3634 | *rtu_Radar410_Info_st_x65_35__ku, const real32_T |
| 3635 | *rtu_Radar410_Info_st_x65_35_O_m, const real32_T |
| 3636 | *rtu_Radar410_Info_st_x65_35_O_f, const real32_T |
| 3637 | *rtu_Radar410_Info_st_x65_35_O_i, const real32_T |
| 3638 | *rtu_Radar410_Info_st_x65_35_O_n, const real32_T |
| 3639 | *rtu_Radar410_Info_st_x65_35__i3, const real32_T |
| 3640 | *rtu_Radar410_Info_st_x65_35_O_b, const real32_T |
| 3641 | *rtu_Radar410_Info_st_x65_35_O_h, const real32_T |
| 3642 | *rtu_Radar410_Info_st_x65_35__if, const real32_T |
| 3643 | *rtu_Radar410_Info_st_x65_35_O_d, const real32_T |
| 3644 | *rtu_Radar410_Info_st_x65_35__dj, const real32_T |
| 3645 | *rtu_Radar410_Info_st_x65_35_O_o, const real32_T |
| 3646 | *rtu_Radar410_Info_st_x65_35__n5, const real32_T |
| 3647 | *rtu_Radar410_Info_st_x65_35__fy, const real32_T |
| 3648 | *rtu_Radar410_Info_st_x66_36_Obj, const real32_T |
| 3649 | *rtu_Radar410_Info_st_x66_36_O_i, const real32_T |
| 3650 | *rtu_Radar410_Info_st_x66_36_O_c, const real32_T |
| 3651 | *rtu_Radar410_Info_st_x66_36_O_n, const real32_T |
| 3652 | *rtu_Radar410_Info_st_x66_36_O_j, const real32_T |
| 3653 | *rtu_Radar410_Info_st_x66_36_O_e, const real32_T |
| 3654 | *rtu_Radar410_Info_st_x66_36_O_a, const real32_T |
| 3655 | *rtu_Radar410_Info_st_x66_36_O_l, const real32_T |
| 3656 | *rtu_Radar410_Info_st_x66_36_O_m, const real32_T |
| 3657 | *rtu_Radar410_Info_st_x66_36_O_h, const real32_T |
| 3658 | *rtu_Radar410_Info_st_x66_36_O_f, const real32_T |
| 3659 | *rtu_Radar410_Info_st_x66_36_O_g, const real32_T |
| 3660 | *rtu_Radar410_Info_st_x66_36_O_d, const real32_T |
| 3661 | *rtu_Radar410_Info_st_x66_36__iz, const real32_T |
| 3662 | *rtu_Radar410_Info_st_x66_36__f4, const real32_T |
| 3663 | *rtu_Radar410_Info_st_x66_36__aj, const real32_T |
| 3664 | *rtu_Radar410_Info_st_x67_37_Obj, const real32_T |
| 3665 | *rtu_Radar410_Info_st_x67_37_O_g, const real32_T |
| 3666 | *rtu_Radar410_Info_st_x67_37_O_o, const real32_T |
| 3667 | *rtu_Radar410_Info_st_x67_37_O_p, const real32_T |
| 3668 | *rtu_Radar410_Info_st_x67_37_O_a, const real32_T |
| 3669 | *rtu_Radar410_Info_st_x67_37__gs, const real32_T |
| 3670 | *rtu_Radar410_Info_st_x67_37_O_e, const real32_T |
| 3671 | *rtu_Radar410_Info_st_x67_37_O_m, const real32_T |
| 3672 | *rtu_Radar410_Info_st_x67_37_O_h, const real32_T |
| 3673 | *rtu_Radar410_Info_st_x67_37_O_l, const real32_T |
| 3674 | *rtu_Radar410_Info_st_x67_37_O_n, const real32_T |
| 3675 | *rtu_Radar410_Info_st_x67_37__mq, const real32_T |
| 3676 | *rtu_Radar410_Info_st_x67_37__er, const real32_T |
| 3677 | *rtu_Radar410_Info_st_x67_37_O_j, const real32_T |
| 3678 | *rtu_Radar410_Info_st_x67_37_O_c, const real32_T |
| 3679 | *rtu_Radar410_Info_st_x67_37__ex, const real32_T |
| 3680 | *rtu_Radar410_Info_st_x68_38_Obj, const real32_T |
| 3681 | *rtu_Radar410_Info_st_x68_38_O_a, const real32_T |
| 3682 | *rtu_Radar410_Info_st_x68_38_O_l, const real32_T |
| 3683 | *rtu_Radar410_Info_st_x68_38__av, const real32_T |
| 3684 | *rtu_Radar410_Info_st_x68_38_O_p, const real32_T |
| 3685 | *rtu_Radar410_Info_st_x68_38_O_n, const real32_T |
| 3686 | *rtu_Radar410_Info_st_x68_38_O_e, const real32_T |
| 3687 | *rtu_Radar410_Info_st_x68_38_O_c, const real32_T |
| 3688 | *rtu_Radar410_Info_st_x68_38__cz, const real32_T |
| 3689 | *rtu_Radar410_Info_st_x68_38_O_j, const real32_T |
| 3690 | *rtu_Radar410_Info_st_x68_38_O_o, const real32_T |
| 3691 | *rtu_Radar410_Info_st_x68_38_O_k, const real32_T |
| 3692 | *rtu_Radar410_Info_st_x68_38__po, const real32_T |
| 3693 | *rtu_Radar410_Info_st_x68_38__ay, const real32_T |
| 3694 | *rtu_Radar410_Info_st_x68_38__pq, const real32_T |
| 3695 | *rtu_Radar410_Info_st_x68_38__or, const real32_T |
| 3696 | *rtu_Radar410_Info_st_x69_39_Obj, const real32_T |
| 3697 | *rtu_Radar410_Info_st_x69_39_O_j, const real32_T |
| 3698 | *rtu_Radar410_Info_st_x69_39_O_c, const real32_T |
| 3699 | *rtu_Radar410_Info_st_x69_39_O_d, const real32_T |
| 3700 | *rtu_Radar410_Info_st_x69_39__dx, const real32_T |
| 3701 | *rtu_Radar410_Info_st_x69_39_O_p, const real32_T |
| 3702 | *rtu_Radar410_Info_st_x69_39__js, const real32_T |
| 3703 | *rtu_Radar410_Info_st_x69_39_O_a, const real32_T |
| 3704 | *rtu_Radar410_Info_st_x69_39_O_e, const real32_T |
| 3705 | *rtu_Radar410_Info_st_x69_39_O_h, const real32_T |
| 3706 | *rtu_Radar410_Info_st_x69_39_O_b, const real32_T |
| 3707 | *rtu_Radar410_Info_st_x69_39_O_l, const real32_T |
| 3708 | *rtu_Radar410_Info_st_x69_39__ji, const real32_T |
| 3709 | *rtu_Radar410_Info_st_x69_39_O_k, const real32_T |
| 3710 | *rtu_Radar410_Info_st_x69_39_O_o, const real32_T |
| 3711 | *rtu_Radar410_Info_st_x69_39__og, const real32_T |
| 3712 | *rtu_Radar410_Info_st_x6A_3A_Obj, const real32_T |
| 3713 | *rtu_Radar410_Info_st_x6A_3A_O_j, const real32_T |
| 3714 | *rtu_Radar410_Info_st_x6A_3A_O_o, const real32_T |
| 3715 | *rtu_Radar410_Info_st_x6A_3A_O_h, const real32_T |
| 3716 | *rtu_Radar410_Info_st_x6A_3A_O_e, const real32_T |
| 3717 | *rtu_Radar410_Info_st_x6A_3A_O_a, const real32_T |
| 3718 | *rtu_Radar410_Info_st_x6A_3A__ad, const real32_T |
| 3719 | *rtu_Radar410_Info_st_x6A_3A__e4, const real32_T |
| 3720 | *rtu_Radar410_Info_st_x6A_3A_O_i, const real32_T |
| 3721 | *rtu_Radar410_Info_st_x6A_3A_O_k, const real32_T |
| 3722 | *rtu_Radar410_Info_st_x6A_3A_O_b, const real32_T |
| 3723 | *rtu_Radar410_Info_st_x6A_3A_O_d, const real32_T |
| 3724 | *rtu_Radar410_Info_st_x6A_3A__du, const real32_T |
| 3725 | *rtu_Radar410_Info_st_x6A_3A_O_n, const real32_T |
| 3726 | *rtu_Radar410_Info_st_x6A_3A_O_l, const real32_T |
| 3727 | *rtu_Radar410_Info_st_x6A_3A__i5, const real32_T |
| 3728 | *rtu_Radar410_Info_st_x6B_3B_Obj, const real32_T |
| 3729 | *rtu_Radar410_Info_st_x6B_3B_O_o, const real32_T |
| 3730 | *rtu_Radar410_Info_st_x6B_3B_O_g, const real32_T |
| 3731 | *rtu_Radar410_Info_st_x6B_3B_O_k, const real32_T |
| 3732 | *rtu_Radar410_Info_st_x6B_3B_O_p, const real32_T |
| 3733 | *rtu_Radar410_Info_st_x6B_3B_O_c, const real32_T |
| 3734 | *rtu_Radar410_Info_st_x6B_3B_O_h, const real32_T |
| 3735 | *rtu_Radar410_Info_st_x6B_3B__cy, const real32_T |
| 3736 | *rtu_Radar410_Info_st_x6B_3B__hk, const real32_T |
| 3737 | *rtu_Radar410_Info_st_x6B_3B__cu, const real32_T |
| 3738 | *rtu_Radar410_Info_st_x6B_3B_O_d, const real32_T |
| 3739 | *rtu_Radar410_Info_st_x6B_3B__g2, const real32_T |
| 3740 | *rtu_Radar410_Info_st_x6B_3B_O_j, const real32_T |
| 3741 | *rtu_Radar410_Info_st_x6B_3B_O_e, const real32_T |
| 3742 | *rtu_Radar410_Info_st_x6B_3B__cf, const real32_T |
| 3743 | *rtu_Radar410_Info_st_x6B_3B__j3, const real32_T |
| 3744 | *rtu_Radar410_Info_st_x6C_3C_Obj, const real32_T |
| 3745 | *rtu_Radar410_Info_st_x6C_3C_O_h, const real32_T |
| 3746 | *rtu_Radar410_Info_st_x6C_3C_O_l, const real32_T |
| 3747 | *rtu_Radar410_Info_st_x6C_3C_O_d, const real32_T |
| 3748 | *rtu_Radar410_Info_st_x6C_3C_O_b, const real32_T |
| 3749 | *rtu_Radar410_Info_st_x6C_3C__bn, const real32_T |
| 3750 | *rtu_Radar410_Info_st_x6C_3C_O_o, const real32_T |
| 3751 | *rtu_Radar410_Info_st_x6C_3C_O_k, const real32_T |
| 3752 | *rtu_Radar410_Info_st_x6C_3C__oi, const real32_T |
| 3753 | *rtu_Radar410_Info_st_x6C_3C_O_c, const real32_T |
| 3754 | *rtu_Radar410_Info_st_x6C_3C_O_a, const real32_T |
| 3755 | *rtu_Radar410_Info_st_x6C_3C__bm, const real32_T |
| 3756 | *rtu_Radar410_Info_st_x6C_3C__ch, const real32_T |
| 3757 | *rtu_Radar410_Info_st_x6C_3C_O_m, const real32_T |
| 3758 | *rtu_Radar410_Info_st_x6C_3C__mz, const real32_T |
| 3759 | *rtu_Radar410_Info_st_x6C_3C__ak, const real32_T |
| 3760 | *rtu_Radar410_Info_st_x6D_3D_Obj, const real32_T |
| 3761 | *rtu_Radar410_Info_st_x6D_3D_O_i, const real32_T |
| 3762 | *rtu_Radar410_Info_st_x6D_3D_O_j, const real32_T |
| 3763 | *rtu_Radar410_Info_st_x6D_3D_O_g, const real32_T |
| 3764 | *rtu_Radar410_Info_st_x6D_3D_O_d, const real32_T |
| 3765 | *rtu_Radar410_Info_st_x6D_3D_O_o, const real32_T |
| 3766 | *rtu_Radar410_Info_st_x6D_3D__oq, const real32_T |
| 3767 | *rtu_Radar410_Info_st_x6D_3D_O_m, const real32_T |
| 3768 | *rtu_Radar410_Info_st_x6D_3D__d5, const real32_T |
| 3769 | *rtu_Radar410_Info_st_x6D_3D_O_b, const real32_T |
| 3770 | *rtu_Radar410_Info_st_x6D_3D__jk, const real32_T |
| 3771 | *rtu_Radar410_Info_st_x6D_3D_O_p, const real32_T |
| 3772 | *rtu_Radar410_Info_st_x6D_3D__jt, const real32_T |
| 3773 | *rtu_Radar410_Info_st_x6D_3D__iy, const real32_T |
| 3774 | *rtu_Radar410_Info_st_x6D_3D__j4, const real32_T |
| 3775 | *rtu_Radar410_Info_st_x6D_3D_O_a, const real32_T |
| 3776 | *rtu_Radar410_Info_st_x6E_3E_Obj, const real32_T |
| 3777 | *rtu_Radar410_Info_st_x6E_3E_O_e, const real32_T |
| 3778 | *rtu_Radar410_Info_st_x6E_3E_O_n, const real32_T |
| 3779 | *rtu_Radar410_Info_st_x6E_3E_O_i, const real32_T |
| 3780 | *rtu_Radar410_Info_st_x6E_3E_O_c, const real32_T |
| 3781 | *rtu_Radar410_Info_st_x6E_3E_O_o, const real32_T |
| 3782 | *rtu_Radar410_Info_st_x6E_3E_O_d, const real32_T |
| 3783 | *rtu_Radar410_Info_st_x6E_3E__nx, const real32_T |
| 3784 | *rtu_Radar410_Info_st_x6E_3E_O_h, const real32_T |
| 3785 | *rtu_Radar410_Info_st_x6E_3E__h1, const real32_T |
| 3786 | *rtu_Radar410_Info_st_x6E_3E_O_k, const real32_T |
| 3787 | *rtu_Radar410_Info_st_x6E_3E_O_f, const real32_T |
| 3788 | *rtu_Radar410_Info_st_x6E_3E_O_g, const real32_T |
| 3789 | *rtu_Radar410_Info_st_x6E_3E_h1d, const real32_T |
| 3790 | *rtu_Radar410_Info_st_x6E_3E__o4, const real32_T |
| 3791 | *rtu_Radar410_Info_st_x6E_3E_O_b, const real32_T |
| 3792 | *rtu_Radar410_Info_st_x6F_3F_Obj, const real32_T |
| 3793 | *rtu_Radar410_Info_st_x6F_3F_O_g, const real32_T |
| 3794 | *rtu_Radar410_Info_st_x6F_3F_O_b, const real32_T |
| 3795 | *rtu_Radar410_Info_st_x6F_3F_O_h, const real32_T |
| 3796 | *rtu_Radar410_Info_st_x6F_3F_O_k, const real32_T |
| 3797 | *rtu_Radar410_Info_st_x6F_3F__gj, const real32_T |
| 3798 | *rtu_Radar410_Info_st_x6F_3F_O_n, const real32_T |
| 3799 | *rtu_Radar410_Info_st_x6F_3F__n1, const real32_T |
| 3800 | *rtu_Radar410_Info_st_x6F_3F__gc, const real32_T |
| 3801 | *rtu_Radar410_Info_st_x6F_3F_O_m, const real32_T |
| 3802 | *rtu_Radar410_Info_st_x6F_3F_O_c, const real32_T |
| 3803 | *rtu_Radar410_Info_st_x6F_3F_O_e, const real32_T |
| 3804 | *rtu_Radar410_Info_st_x6F_3F__gu, const real32_T |
| 3805 | *rtu_Radar410_Info_st_x6F_3F_O_i, const real32_T |
| 3806 | *rtu_Radar410_Info_st_x6F_3F_O_a, const real32_T |
| 3807 | *rtu_Radar410_Info_st_x6F_3F_O_l, const real32_T |
| 3808 | *rtu_Radar410_Info_st_x70_40_Obj, const real32_T |
| 3809 | *rtu_Radar410_Info_st_x70_40_O_k, const real32_T |
| 3810 | *rtu_Radar410_Info_st_x70_40_O_m, const real32_T |
| 3811 | *rtu_Radar410_Info_st_x70_40_O_n, const real32_T |
| 3812 | *rtu_Radar410_Info_st_x70_40__ms, const real32_T |
| 3813 | *rtu_Radar410_Info_st_x70_40_O_i, const real32_T |
| 3814 | *rtu_Radar410_Info_st_x70_40__ih, const real32_T |
| 3815 | *rtu_Radar410_Info_st_x70_40_O_b, const real32_T |
| 3816 | *rtu_Radar410_Info_st_x70_40_O_c, const real32_T |
| 3817 | *rtu_Radar410_Info_st_x70_40_O_h, const real32_T |
| 3818 | *rtu_Radar410_Info_st_x70_40_O_f, const real32_T |
| 3819 | *rtu_Radar410_Info_st_x70_40__bd, const real32_T |
| 3820 | *rtu_Radar410_Info_st_x70_40__fv, const real32_T |
| 3821 | *rtu_Radar410_Info_st_x70_40__bp, const real32_T |
| 3822 | *rtu_Radar410_Info_st_x70_40__f2, const real32_T |
| 3823 | *rtu_Radar410_Info_st_x70_40_O_o, const real32_T |
| 3824 | *rtu_Radar410_Info_st_x71_41_Obj, const real32_T |
| 3825 | *rtu_Radar410_Info_st_x71_41_O_m, const real32_T |
| 3826 | *rtu_Radar410_Info_st_x71_41_O_c, const real32_T |
| 3827 | *rtu_Radar410_Info_st_x71_41_O_l, const real32_T |
| 3828 | *rtu_Radar410_Info_st_x71_41_O_k, const real32_T |
| 3829 | *rtu_Radar410_Info_st_x71_41__lp, const real32_T |
| 3830 | *rtu_Radar410_Info_st_x71_41_O_f, const real32_T |
| 3831 | *rtu_Radar410_Info_st_x71_41_O_h, const real32_T |
| 3832 | *rtu_Radar410_Info_st_x71_41_O_g, const real32_T |
| 3833 | *rtu_Radar410_Info_st_x71_41__ma, const real32_T |
| 3834 | *rtu_Radar410_Info_st_x71_41_O_e, const real32_T |
| 3835 | *rtu_Radar410_Info_st_x71_41_O_b, const real32_T |
| 3836 | *rtu_Radar410_Info_st_x71_41__ha, const real32_T |
| 3837 | *rtu_Radar410_Info_st_x71_41_O_j, const real32_T |
| 3838 | *rtu_Radar410_Info_st_x71_41_O_p, const real32_T |
| 3839 | *rtu_Radar410_Info_st_x71_41__ev, const real32_T |
| 3840 | *rtu_Radar410_Info_st_x72_42_Obj, const real32_T |
| 3841 | *rtu_Radar410_Info_st_x72_42_O_a, const real32_T |
| 3842 | *rtu_Radar410_Info_st_x72_42_O_b, const real32_T |
| 3843 | *rtu_Radar410_Info_st_x72_42_O_m, const real32_T |
| 3844 | *rtu_Radar410_Info_st_x72_42_O_h, const real32_T |
| 3845 | *rtu_Radar410_Info_st_x72_42_O_n, const real32_T |
| 3846 | *rtu_Radar410_Info_st_x72_42_O_k, const real32_T |
| 3847 | *rtu_Radar410_Info_st_x72_42_O_e, const real32_T |
| 3848 | *rtu_Radar410_Info_st_x72_42_O_f, const real32_T |
| 3849 | *rtu_Radar410_Info_st_x72_42_O_l, const real32_T |
| 3850 | *rtu_Radar410_Info_st_x72_42__mh, const real32_T |
| 3851 | *rtu_Radar410_Info_st_x72_42__ly, const real32_T |
| 3852 | *rtu_Radar410_Info_st_x72_42__ag, const real32_T |
| 3853 | *rtu_Radar410_Info_st_x72_42__mf, const real32_T |
| 3854 | *rtu_Radar410_Info_st_x72_42__nk, const real32_T |
| 3855 | *rtu_Radar410_Info_st_x72_42__fn, const real32_T |
| 3856 | *rtu_Radar410_Info_st_x73_43_Obj, const real32_T |
| 3857 | *rtu_Radar410_Info_st_x73_43_O_l, const real32_T |
| 3858 | *rtu_Radar410_Info_st_x73_43__ll, const real32_T |
| 3859 | *rtu_Radar410_Info_st_x73_43_O_f, const real32_T |
| 3860 | *rtu_Radar410_Info_st_x73_43_O_b, const real32_T |
| 3861 | *rtu_Radar410_Info_st_x73_43_O_g, const real32_T |
| 3862 | *rtu_Radar410_Info_st_x73_43_O_d, const real32_T |
| 3863 | *rtu_Radar410_Info_st_x73_43_O_p, const real32_T |
| 3864 | *rtu_Radar410_Info_st_x73_43_O_e, const real32_T |
| 3865 | *rtu_Radar410_Info_st_x73_43__dw, const real32_T |
| 3866 | *rtu_Radar410_Info_st_x73_43__fs, const real32_T |
| 3867 | *rtu_Radar410_Info_st_x73_43_O_o, const real32_T |
| 3868 | *rtu_Radar410_Info_st_x73_43__em, const real32_T |
| 3869 | *rtu_Radar410_Info_st_x73_43__lh, const real32_T |
| 3870 | *rtu_Radar410_Info_st_x73_43__gf, const real32_T |
| 3871 | *rtu_Radar410_Info_st_x73_43__f1, const real32_T |
| 3872 | *rtu_Radar410_Info_st_x74_44_Obj, const real32_T |
| 3873 | *rtu_Radar410_Info_st_x74_44_O_c, const real32_T |
| 3874 | *rtu_Radar410_Info_st_x74_44_O_g, const real32_T |
| 3875 | *rtu_Radar410_Info_st_x74_44_O_e, const real32_T |
| 3876 | *rtu_Radar410_Info_st_x74_44_O_p, const real32_T |
| 3877 | *rtu_Radar410_Info_st_x74_44_O_a, const real32_T |
| 3878 | *rtu_Radar410_Info_st_x74_44_O_n, const real32_T |
| 3879 | *rtu_Radar410_Info_st_x74_44__nd, const real32_T |
| 3880 | *rtu_Radar410_Info_st_x74_44_O_m, const real32_T |
| 3881 | *rtu_Radar410_Info_st_x74_44_O_h, const real32_T |
| 3882 | *rtu_Radar410_Info_st_x74_44_O_j, const real32_T |
| 3883 | *rtu_Radar410_Info_st_x74_44_O_b, const real32_T |
| 3884 | *rtu_Radar410_Info_st_x74_44__my, const real32_T |
| 3885 | *rtu_Radar410_Info_st_x74_44__g5, const real32_T |
| 3886 | *rtu_Radar410_Info_st_x74_44__eq, const real32_T |
| 3887 | *rtu_Radar410_Info_st_x74_44_O_k, const real32_T |
| 3888 | *rtu_Radar410_Info_st_x75_45_Obj, const real32_T |
| 3889 | *rtu_Radar410_Info_st_x75_45_O_b, const real32_T |
| 3890 | *rtu_Radar410_Info_st_x75_45_O_g, const real32_T |
| 3891 | *rtu_Radar410_Info_st_x75_45_O_m, const real32_T |
| 3892 | *rtu_Radar410_Info_st_x75_45_O_n, const real32_T |
| 3893 | *rtu_Radar410_Info_st_x75_45_O_k, const real32_T |
| 3894 | *rtu_Radar410_Info_st_x75_45__kf, const real32_T |
| 3895 | *rtu_Radar410_Info_st_x75_45_O_i, const real32_T |
| 3896 | *rtu_Radar410_Info_st_x75_45_O_p, const real32_T |
| 3897 | *rtu_Radar410_Info_st_x75_45_O_j, const real32_T |
| 3898 | *rtu_Radar410_Info_st_x75_45_O_l, const real32_T |
| 3899 | *rtu_Radar410_Info_st_x75_45__jl, const real32_T |
| 3900 | *rtu_Radar410_Info_st_x75_45__l5, const real32_T |
| 3901 | *rtu_Radar410_Info_st_x75_45__mo, const real32_T |
| 3902 | *rtu_Radar410_Info_st_x75_45__gp, const real32_T |
| 3903 | *rtu_Radar410_Info_st_x75_45__i4, const real32_T |
| 3904 | *rtu_Radar410_Info_st_x76_46_Obj, const real32_T |
| 3905 | *rtu_Radar410_Info_st_x76_46_O_l, const real32_T |
| 3906 | *rtu_Radar410_Info_st_x76_46_O_g, const real32_T |
| 3907 | *rtu_Radar410_Info_st_x76_46_O_n, const real32_T |
| 3908 | *rtu_Radar410_Info_st_x76_46__l3, const real32_T |
| 3909 | *rtu_Radar410_Info_st_x76_46_O_b, const real32_T |
| 3910 | *rtu_Radar410_Info_st_x76_46_O_j, const real32_T |
| 3911 | *rtu_Radar410_Info_st_x76_46_O_o, const real32_T |
| 3912 | *rtu_Radar410_Info_st_x76_46__jw, const real32_T |
| 3913 | *rtu_Radar410_Info_st_x76_46__bq, const real32_T |
| 3914 | *rtu_Radar410_Info_st_x76_46__bl, const real32_T |
| 3915 | *rtu_Radar410_Info_st_x76_46_O_c, const real32_T |
| 3916 | *rtu_Radar410_Info_st_x76_46__cc, const real32_T |
| 3917 | *rtu_Radar410_Info_st_x76_46__os, const real32_T |
| 3918 | *rtu_Radar410_Info_st_x76_46_O_k, const real32_T |
| 3919 | *rtu_Radar410_Info_st_x76_46_O_m, const real32_T |
| 3920 | *rtu_Radar410_Info_st_x77_47_Obj, const real32_T |
| 3921 | *rtu_Radar410_Info_st_x77_47_O_g, const real32_T |
| 3922 | *rtu_Radar410_Info_st_x77_47_O_k, const real32_T |
| 3923 | *rtu_Radar410_Info_st_x77_47_O_e, const real32_T |
| 3924 | *rtu_Radar410_Info_st_x77_47__go, const real32_T |
| 3925 | *rtu_Radar410_Info_st_x77_47_O_h, const real32_T |
| 3926 | *rtu_Radar410_Info_st_x77_47_O_l, const real32_T |
| 3927 | *rtu_Radar410_Info_st_x77_47_O_j, const real32_T |
| 3928 | *rtu_Radar410_Info_st_x77_47_O_f, const real32_T |
| 3929 | *rtu_Radar410_Info_st_x77_47_O_a, const real32_T |
| 3930 | *rtu_Radar410_Info_st_x77_47_O_i, const real32_T |
| 3931 | *rtu_Radar410_Info_st_x77_47_O_p, const real32_T |
| 3932 | *rtu_Radar410_Info_st_x77_47__fx, const real32_T |
| 3933 | *rtu_Radar410_Info_st_x77_47__ey, const real32_T |
| 3934 | *rtu_Radar410_Info_st_x77_47_O_m, const real32_T |
| 3935 | *rtu_Radar410_Info_st_x77_47__me, const real32_T |
| 3936 | *rtu_Radar410_Info_st_x80_Status, const real32_T |
| 3937 | *rtu_Radar410_Info_st_x80_Stat_p, const real32_T |
| 3938 | *rtu_Radar410_Info_st_x80_Stat_d, const real32_T |
| 3939 | *rtu_Radar410_Info_st_x80_Stat_l, const real32_T |
| 3940 | *rtu_Radar410_Info_st_x80_Stat_h, const real32_T |
| 3941 | *rtu_Radar410_Info_st_x80_Sta_lz, const real32_T |
| 3942 | *rtu_Radar410_Info_st_x80_Stat_n, const real32_T |
| 3943 | *rtu_Radar410_Info_st_x80_Stat_i, const real32_T |
| 3944 | *rtu_Radar410_Info_st_x80_Stat_o, const real32_T |
| 3945 | *rtu_Radar410_Info_st_x80_Sta_iy, const real32_T |
| 3946 | *rtu_Radar410_Info_st_x80_Stat_b, const ARS308_RX |
| 3947 | *rtu_Radar308_Info_st, const EYEQ4_DATA_RT_ST *rtu_EyeQ4_Info_st, |
| 3948 | const real32_T *rtu_VSI_VehState_st_YrsF, const real32_T |
| 3949 | *rtu_VSI_VehState_st_vRef, const real32_T |
| 3950 | *rtu_VSI_VehState_st_aRef, FUS_OBJ_OUTPUT_ST |
| 3951 | *rty_FUS_ObjOutput_st, FUS_LANE_OUTPUT_ST *rty_FUS_LaneOutput_st, |
| 3952 | FUS_ROAD_EDGE_OUTPUT_ST *rty_FUS_RoadEdgeOutput_st) |
| 3953 | { |
| 3954 | uint32_T bpIdx; |
| 3955 | real32_T tmp; |
| 3956 | |
| 3957 | /* DataTypeConversion: '<S181>/Data Type Conversion' */ |
| 3958 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x50_20__ka); |
| 3959 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 3960 | tmp = 0.0F; |
| 3961 | } else { |
| 3962 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 3963 | } |
| 3964 | |
| 3965 | fusionAlg_B.radarObj.radar_01_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 3966 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 3967 | |
| 3968 | /* End of DataTypeConversion: '<S181>/Data Type Conversion' */ |
| 3969 | |
| 3970 | /* DataTypeConversion: '<S181>/Data Type Conversion1' */ |
| 3971 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x50_20__kw); |
| 3972 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 3973 | tmp = 0.0F; |
| 3974 | } else { |
| 3975 | tmp = (real32_T)fmod(tmp, 256.0); |
| 3976 | } |
| 3977 | |
| 3978 | fusionAlg_B.radarObj.radar_01_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 3979 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 3980 | |
| 3981 | /* End of DataTypeConversion: '<S181>/Data Type Conversion1' */ |
| 3982 | |
| 3983 | /* DataTypeConversion: '<S181>/Data Type Conversion2' */ |
| 3984 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x50_20_O_k); |
| 3985 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 3986 | tmp = 0.0F; |
| 3987 | } else { |
| 3988 | tmp = (real32_T)fmod(tmp, 256.0); |
| 3989 | } |
| 3990 | |
| 3991 | fusionAlg_B.radarObj.radar_01_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 3992 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 3993 | |
| 3994 | /* End of DataTypeConversion: '<S181>/Data Type Conversion2' */ |
| 3995 | |
| 3996 | /* DataTypeConversion: '<S181>/Data Type Conversion3' */ |
| 3997 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x50_20_O_n); |
| 3998 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 3999 | tmp = 0.0F; |
| 4000 | } else { |
| 4001 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4002 | } |
| 4003 | |
| 4004 | fusionAlg_B.radarObj.radar_01_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4005 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4006 | |
| 4007 | /* End of DataTypeConversion: '<S181>/Data Type Conversion3' */ |
| 4008 | |
| 4009 | /* DataTypeConversion: '<S181>/Data Type Conversion4' */ |
| 4010 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x50_20__cj); |
| 4011 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4012 | tmp = 0.0F; |
| 4013 | } else { |
| 4014 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4015 | } |
| 4016 | |
| 4017 | fusionAlg_B.radarObj.radar_01_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4018 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4019 | |
| 4020 | /* End of DataTypeConversion: '<S181>/Data Type Conversion4' */ |
| 4021 | |
| 4022 | /* DataTypeConversion: '<S181>/Data Type Conversion5' */ |
| 4023 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x50_20_kaa); |
| 4024 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4025 | tmp = 0.0F; |
| 4026 | } else { |
| 4027 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4028 | } |
| 4029 | |
| 4030 | fusionAlg_B.radarObj.radar_01_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4031 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4032 | |
| 4033 | /* End of DataTypeConversion: '<S181>/Data Type Conversion5' */ |
| 4034 | |
| 4035 | /* BusCreator: '<S181>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4036 | * Constant: '<S181>/Constant' |
| 4037 | * Constant: '<S181>/Constant1' |
| 4038 | */ |
| 4039 | fusionAlg_B.radarObj.radar_01_obj.reserved.reserved1 = |
| 4040 | fusionAlg_P_g.Constant_Value_ob; |
| 4041 | fusionAlg_B.radarObj.radar_01_obj.reserved.reserved0 = |
| 4042 | fusionAlg_P_g.Constant1_Value_m2; |
| 4043 | |
| 4044 | /* BusCreator: '<S181>/Bus Creator1' */ |
| 4045 | fusionAlg_B.radarObj.radar_01_obj.objObstacleProb = |
| 4046 | *rtu_Radar410_Info_st_x50_20_O_e; |
| 4047 | fusionAlg_B.radarObj.radar_01_obj.objXPos_Stdev = |
| 4048 | *rtu_Radar410_Info_st_x50_20_O_h; |
| 4049 | fusionAlg_B.radarObj.radar_01_obj.objYPos_Stdev = |
| 4050 | *rtu_Radar410_Info_st_x50_20_O_f; |
| 4051 | fusionAlg_B.radarObj.radar_01_obj.objXVelRel_Stdev = |
| 4052 | *rtu_Radar410_Info_st_x50_20_O_g; |
| 4053 | fusionAlg_B.radarObj.radar_01_obj.objXAccRel = |
| 4054 | *rtu_Radar410_Info_st_x50_20_O_c; |
| 4055 | fusionAlg_B.radarObj.radar_01_obj.objExstProb = |
| 4056 | *rtu_Radar410_Info_st_x50_20_Obj; |
| 4057 | fusionAlg_B.radarObj.radar_01_obj.objYVelRel = |
| 4058 | *rtu_Radar410_Info_st_x50_20__el; |
| 4059 | fusionAlg_B.radarObj.radar_01_obj.objXVelRel = |
| 4060 | *rtu_Radar410_Info_st_x50_20_O_p; |
| 4061 | fusionAlg_B.radarObj.radar_01_obj.objXPos = *rtu_Radar410_Info_st_x50_20__ez; |
| 4062 | fusionAlg_B.radarObj.radar_01_obj.objYPos = *rtu_Radar410_Info_st_x50_20_O_o; |
| 4063 | |
| 4064 | /* DataTypeConversion: '<S182>/Data Type Conversion' */ |
| 4065 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x51_21_O_e); |
| 4066 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4067 | tmp = 0.0F; |
| 4068 | } else { |
| 4069 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 4070 | } |
| 4071 | |
| 4072 | fusionAlg_B.radarObj.radar_02_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 4073 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 4074 | |
| 4075 | /* End of DataTypeConversion: '<S182>/Data Type Conversion' */ |
| 4076 | |
| 4077 | /* DataTypeConversion: '<S182>/Data Type Conversion1' */ |
| 4078 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x51_21_O_o); |
| 4079 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4080 | tmp = 0.0F; |
| 4081 | } else { |
| 4082 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4083 | } |
| 4084 | |
| 4085 | fusionAlg_B.radarObj.radar_02_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 4086 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4087 | |
| 4088 | /* End of DataTypeConversion: '<S182>/Data Type Conversion1' */ |
| 4089 | |
| 4090 | /* DataTypeConversion: '<S182>/Data Type Conversion2' */ |
| 4091 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x51_21__pr); |
| 4092 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4093 | tmp = 0.0F; |
| 4094 | } else { |
| 4095 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4096 | } |
| 4097 | |
| 4098 | fusionAlg_B.radarObj.radar_02_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 4099 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4100 | |
| 4101 | /* End of DataTypeConversion: '<S182>/Data Type Conversion2' */ |
| 4102 | |
| 4103 | /* DataTypeConversion: '<S182>/Data Type Conversion3' */ |
| 4104 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x51_21_O_p); |
| 4105 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4106 | tmp = 0.0F; |
| 4107 | } else { |
| 4108 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4109 | } |
| 4110 | |
| 4111 | fusionAlg_B.radarObj.radar_02_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4112 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4113 | |
| 4114 | /* End of DataTypeConversion: '<S182>/Data Type Conversion3' */ |
| 4115 | |
| 4116 | /* DataTypeConversion: '<S182>/Data Type Conversion4' */ |
| 4117 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x51_21__po); |
| 4118 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4119 | tmp = 0.0F; |
| 4120 | } else { |
| 4121 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4122 | } |
| 4123 | |
| 4124 | fusionAlg_B.radarObj.radar_02_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4125 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4126 | |
| 4127 | /* End of DataTypeConversion: '<S182>/Data Type Conversion4' */ |
| 4128 | |
| 4129 | /* DataTypeConversion: '<S182>/Data Type Conversion5' */ |
| 4130 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x51_21__mc); |
| 4131 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4132 | tmp = 0.0F; |
| 4133 | } else { |
| 4134 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4135 | } |
| 4136 | |
| 4137 | fusionAlg_B.radarObj.radar_02_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4138 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4139 | |
| 4140 | /* End of DataTypeConversion: '<S182>/Data Type Conversion5' */ |
| 4141 | |
| 4142 | /* BusCreator: '<S182>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4143 | * Constant: '<S182>/Constant' |
| 4144 | * Constant: '<S182>/Constant1' |
| 4145 | */ |
| 4146 | fusionAlg_B.radarObj.radar_02_obj.reserved.reserved1 = |
| 4147 | fusionAlg_P_g.Constant_Value_no; |
| 4148 | fusionAlg_B.radarObj.radar_02_obj.reserved.reserved0 = |
| 4149 | fusionAlg_P_g.Constant1_Value_ic; |
| 4150 | |
| 4151 | /* BusCreator: '<S182>/Bus Creator1' */ |
| 4152 | fusionAlg_B.radarObj.radar_02_obj.objObstacleProb = |
| 4153 | *rtu_Radar410_Info_st_x51_21_O_m; |
| 4154 | fusionAlg_B.radarObj.radar_02_obj.objXPos_Stdev = |
| 4155 | *rtu_Radar410_Info_st_x51_21__pe; |
| 4156 | fusionAlg_B.radarObj.radar_02_obj.objYPos_Stdev = |
| 4157 | *rtu_Radar410_Info_st_x51_21_O_i; |
| 4158 | fusionAlg_B.radarObj.radar_02_obj.objXVelRel_Stdev = |
| 4159 | *rtu_Radar410_Info_st_x51_21_O_d; |
| 4160 | fusionAlg_B.radarObj.radar_02_obj.objXAccRel = |
| 4161 | *rtu_Radar410_Info_st_x51_21_O_g; |
| 4162 | fusionAlg_B.radarObj.radar_02_obj.objExstProb = |
| 4163 | *rtu_Radar410_Info_st_x51_21_Obj; |
| 4164 | fusionAlg_B.radarObj.radar_02_obj.objYVelRel = |
| 4165 | *rtu_Radar410_Info_st_x51_21_O_j; |
| 4166 | fusionAlg_B.radarObj.radar_02_obj.objXVelRel = |
| 4167 | *rtu_Radar410_Info_st_x51_21__i3; |
| 4168 | fusionAlg_B.radarObj.radar_02_obj.objXPos = *rtu_Radar410_Info_st_x51_21__m3; |
| 4169 | fusionAlg_B.radarObj.radar_02_obj.objYPos = *rtu_Radar410_Info_st_x51_21__p2; |
| 4170 | |
| 4171 | /* DataTypeConversion: '<S193>/Data Type Conversion' */ |
| 4172 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x52_22_O_c); |
| 4173 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4174 | tmp = 0.0F; |
| 4175 | } else { |
| 4176 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 4177 | } |
| 4178 | |
| 4179 | fusionAlg_B.radarObj.radar_03_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 4180 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 4181 | |
| 4182 | /* End of DataTypeConversion: '<S193>/Data Type Conversion' */ |
| 4183 | |
| 4184 | /* DataTypeConversion: '<S193>/Data Type Conversion1' */ |
| 4185 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x52_22__bn); |
| 4186 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4187 | tmp = 0.0F; |
| 4188 | } else { |
| 4189 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4190 | } |
| 4191 | |
| 4192 | fusionAlg_B.radarObj.radar_03_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 4193 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4194 | |
| 4195 | /* End of DataTypeConversion: '<S193>/Data Type Conversion1' */ |
| 4196 | |
| 4197 | /* DataTypeConversion: '<S193>/Data Type Conversion2' */ |
| 4198 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x52_22_O_e); |
| 4199 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4200 | tmp = 0.0F; |
| 4201 | } else { |
| 4202 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4203 | } |
| 4204 | |
| 4205 | fusionAlg_B.radarObj.radar_03_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 4206 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4207 | |
| 4208 | /* End of DataTypeConversion: '<S193>/Data Type Conversion2' */ |
| 4209 | |
| 4210 | /* DataTypeConversion: '<S193>/Data Type Conversion3' */ |
| 4211 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x52_22_O_g); |
| 4212 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4213 | tmp = 0.0F; |
| 4214 | } else { |
| 4215 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4216 | } |
| 4217 | |
| 4218 | fusionAlg_B.radarObj.radar_03_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4219 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4220 | |
| 4221 | /* End of DataTypeConversion: '<S193>/Data Type Conversion3' */ |
| 4222 | |
| 4223 | /* DataTypeConversion: '<S193>/Data Type Conversion4' */ |
| 4224 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x52_22__py); |
| 4225 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4226 | tmp = 0.0F; |
| 4227 | } else { |
| 4228 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4229 | } |
| 4230 | |
| 4231 | fusionAlg_B.radarObj.radar_03_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4232 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4233 | |
| 4234 | /* End of DataTypeConversion: '<S193>/Data Type Conversion4' */ |
| 4235 | |
| 4236 | /* DataTypeConversion: '<S193>/Data Type Conversion5' */ |
| 4237 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x52_22_O_l); |
| 4238 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4239 | tmp = 0.0F; |
| 4240 | } else { |
| 4241 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4242 | } |
| 4243 | |
| 4244 | fusionAlg_B.radarObj.radar_03_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4245 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4246 | |
| 4247 | /* End of DataTypeConversion: '<S193>/Data Type Conversion5' */ |
| 4248 | |
| 4249 | /* BusCreator: '<S193>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4250 | * Constant: '<S193>/Constant' |
| 4251 | * Constant: '<S193>/Constant1' |
| 4252 | */ |
| 4253 | fusionAlg_B.radarObj.radar_03_obj.reserved.reserved1 = |
| 4254 | fusionAlg_P_g.Constant_Value_gn0; |
| 4255 | fusionAlg_B.radarObj.radar_03_obj.reserved.reserved0 = |
| 4256 | fusionAlg_P_g.Constant1_Value_fh; |
| 4257 | |
| 4258 | /* BusCreator: '<S193>/Bus Creator1' */ |
| 4259 | fusionAlg_B.radarObj.radar_03_obj.objObstacleProb = |
| 4260 | *rtu_Radar410_Info_st_x52_22_O_n; |
| 4261 | fusionAlg_B.radarObj.radar_03_obj.objXPos_Stdev = |
| 4262 | *rtu_Radar410_Info_st_x52_22_O_k; |
| 4263 | fusionAlg_B.radarObj.radar_03_obj.objYPos_Stdev = |
| 4264 | *rtu_Radar410_Info_st_x52_22__go; |
| 4265 | fusionAlg_B.radarObj.radar_03_obj.objXVelRel_Stdev = |
| 4266 | *rtu_Radar410_Info_st_x52_22_O_h; |
| 4267 | fusionAlg_B.radarObj.radar_03_obj.objXAccRel = |
| 4268 | *rtu_Radar410_Info_st_x52_22_O_b; |
| 4269 | fusionAlg_B.radarObj.radar_03_obj.objExstProb = |
| 4270 | *rtu_Radar410_Info_st_x52_22_Obj; |
| 4271 | fusionAlg_B.radarObj.radar_03_obj.objYVelRel = |
| 4272 | *rtu_Radar410_Info_st_x52_22_O_p; |
| 4273 | fusionAlg_B.radarObj.radar_03_obj.objXVelRel = |
| 4274 | *rtu_Radar410_Info_st_x52_22_O_m; |
| 4275 | fusionAlg_B.radarObj.radar_03_obj.objXPos = *rtu_Radar410_Info_st_x52_22__en; |
| 4276 | fusionAlg_B.radarObj.radar_03_obj.objYPos = *rtu_Radar410_Info_st_x52_22__px; |
| 4277 | |
| 4278 | /* DataTypeConversion: '<S204>/Data Type Conversion' */ |
| 4279 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x53_23__h5); |
| 4280 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4281 | tmp = 0.0F; |
| 4282 | } else { |
| 4283 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 4284 | } |
| 4285 | |
| 4286 | fusionAlg_B.radarObj.radar_04_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 4287 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 4288 | |
| 4289 | /* End of DataTypeConversion: '<S204>/Data Type Conversion' */ |
| 4290 | |
| 4291 | /* DataTypeConversion: '<S204>/Data Type Conversion1' */ |
| 4292 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x53_23_O_i); |
| 4293 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4294 | tmp = 0.0F; |
| 4295 | } else { |
| 4296 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4297 | } |
| 4298 | |
| 4299 | fusionAlg_B.radarObj.radar_04_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 4300 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4301 | |
| 4302 | /* End of DataTypeConversion: '<S204>/Data Type Conversion1' */ |
| 4303 | |
| 4304 | /* DataTypeConversion: '<S204>/Data Type Conversion2' */ |
| 4305 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x53_23__h2); |
| 4306 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4307 | tmp = 0.0F; |
| 4308 | } else { |
| 4309 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4310 | } |
| 4311 | |
| 4312 | fusionAlg_B.radarObj.radar_04_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 4313 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4314 | |
| 4315 | /* End of DataTypeConversion: '<S204>/Data Type Conversion2' */ |
| 4316 | |
| 4317 | /* DataTypeConversion: '<S204>/Data Type Conversion3' */ |
| 4318 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x53_23_O_h); |
| 4319 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4320 | tmp = 0.0F; |
| 4321 | } else { |
| 4322 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4323 | } |
| 4324 | |
| 4325 | fusionAlg_B.radarObj.radar_04_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4326 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4327 | |
| 4328 | /* End of DataTypeConversion: '<S204>/Data Type Conversion3' */ |
| 4329 | |
| 4330 | /* DataTypeConversion: '<S204>/Data Type Conversion4' */ |
| 4331 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x53_23__dz); |
| 4332 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4333 | tmp = 0.0F; |
| 4334 | } else { |
| 4335 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4336 | } |
| 4337 | |
| 4338 | fusionAlg_B.radarObj.radar_04_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4339 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4340 | |
| 4341 | /* End of DataTypeConversion: '<S204>/Data Type Conversion4' */ |
| 4342 | |
| 4343 | /* DataTypeConversion: '<S204>/Data Type Conversion5' */ |
| 4344 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x53_23__h1); |
| 4345 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4346 | tmp = 0.0F; |
| 4347 | } else { |
| 4348 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4349 | } |
| 4350 | |
| 4351 | fusionAlg_B.radarObj.radar_04_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4352 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4353 | |
| 4354 | /* End of DataTypeConversion: '<S204>/Data Type Conversion5' */ |
| 4355 | |
| 4356 | /* BusCreator: '<S204>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4357 | * Constant: '<S204>/Constant' |
| 4358 | * Constant: '<S204>/Constant1' |
| 4359 | */ |
| 4360 | fusionAlg_B.radarObj.radar_04_obj.reserved.reserved1 = |
| 4361 | fusionAlg_P_g.Constant_Value_mgw; |
| 4362 | fusionAlg_B.radarObj.radar_04_obj.reserved.reserved0 = |
| 4363 | fusionAlg_P_g.Constant1_Value_fw; |
| 4364 | |
| 4365 | /* BusCreator: '<S204>/Bus Creator1' */ |
| 4366 | fusionAlg_B.radarObj.radar_04_obj.objObstacleProb = |
| 4367 | *rtu_Radar410_Info_st_x53_23_O_m; |
| 4368 | fusionAlg_B.radarObj.radar_04_obj.objXPos_Stdev = |
| 4369 | *rtu_Radar410_Info_st_x53_23__hs; |
| 4370 | fusionAlg_B.radarObj.radar_04_obj.objYPos_Stdev = |
| 4371 | *rtu_Radar410_Info_st_x53_23__hz; |
| 4372 | fusionAlg_B.radarObj.radar_04_obj.objXVelRel_Stdev = |
| 4373 | *rtu_Radar410_Info_st_x53_23_O_f; |
| 4374 | fusionAlg_B.radarObj.radar_04_obj.objXAccRel = |
| 4375 | *rtu_Radar410_Info_st_x53_23_O_d; |
| 4376 | fusionAlg_B.radarObj.radar_04_obj.objExstProb = |
| 4377 | *rtu_Radar410_Info_st_x53_23_Obj; |
| 4378 | fusionAlg_B.radarObj.radar_04_obj.objYVelRel = |
| 4379 | *rtu_Radar410_Info_st_x53_23__ig; |
| 4380 | fusionAlg_B.radarObj.radar_04_obj.objXVelRel = |
| 4381 | *rtu_Radar410_Info_st_x53_23_O_b; |
| 4382 | fusionAlg_B.radarObj.radar_04_obj.objXPos = *rtu_Radar410_Info_st_x53_23_O_a; |
| 4383 | fusionAlg_B.radarObj.radar_04_obj.objYPos = *rtu_Radar410_Info_st_x53_23__id; |
| 4384 | |
| 4385 | /* DataTypeConversion: '<S208>/Data Type Conversion' */ |
| 4386 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x54_24__h2); |
| 4387 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4388 | tmp = 0.0F; |
| 4389 | } else { |
| 4390 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 4391 | } |
| 4392 | |
| 4393 | fusionAlg_B.radarObj.radar_05_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 4394 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 4395 | |
| 4396 | /* End of DataTypeConversion: '<S208>/Data Type Conversion' */ |
| 4397 | |
| 4398 | /* DataTypeConversion: '<S208>/Data Type Conversion1' */ |
| 4399 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x54_24__ef); |
| 4400 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4401 | tmp = 0.0F; |
| 4402 | } else { |
| 4403 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4404 | } |
| 4405 | |
| 4406 | fusionAlg_B.radarObj.radar_05_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 4407 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4408 | |
| 4409 | /* End of DataTypeConversion: '<S208>/Data Type Conversion1' */ |
| 4410 | |
| 4411 | /* DataTypeConversion: '<S208>/Data Type Conversion2' */ |
| 4412 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x54_24__hc); |
| 4413 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4414 | tmp = 0.0F; |
| 4415 | } else { |
| 4416 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4417 | } |
| 4418 | |
| 4419 | fusionAlg_B.radarObj.radar_05_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 4420 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4421 | |
| 4422 | /* End of DataTypeConversion: '<S208>/Data Type Conversion2' */ |
| 4423 | |
| 4424 | /* DataTypeConversion: '<S208>/Data Type Conversion3' */ |
| 4425 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x54_24__le); |
| 4426 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4427 | tmp = 0.0F; |
| 4428 | } else { |
| 4429 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4430 | } |
| 4431 | |
| 4432 | fusionAlg_B.radarObj.radar_05_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4433 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4434 | |
| 4435 | /* End of DataTypeConversion: '<S208>/Data Type Conversion3' */ |
| 4436 | |
| 4437 | /* DataTypeConversion: '<S208>/Data Type Conversion4' */ |
| 4438 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x54_24_O_k); |
| 4439 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4440 | tmp = 0.0F; |
| 4441 | } else { |
| 4442 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4443 | } |
| 4444 | |
| 4445 | fusionAlg_B.radarObj.radar_05_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4446 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4447 | |
| 4448 | /* End of DataTypeConversion: '<S208>/Data Type Conversion4' */ |
| 4449 | |
| 4450 | /* DataTypeConversion: '<S208>/Data Type Conversion5' */ |
| 4451 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x54_24_O_b); |
| 4452 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4453 | tmp = 0.0F; |
| 4454 | } else { |
| 4455 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4456 | } |
| 4457 | |
| 4458 | fusionAlg_B.radarObj.radar_05_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4459 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4460 | |
| 4461 | /* End of DataTypeConversion: '<S208>/Data Type Conversion5' */ |
| 4462 | |
| 4463 | /* BusCreator: '<S208>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4464 | * Constant: '<S208>/Constant' |
| 4465 | * Constant: '<S208>/Constant1' |
| 4466 | */ |
| 4467 | fusionAlg_B.radarObj.radar_05_obj.reserved.reserved1 = |
| 4468 | fusionAlg_P_g.Constant_Value_a3; |
| 4469 | fusionAlg_B.radarObj.radar_05_obj.reserved.reserved0 = |
| 4470 | fusionAlg_P_g.Constant1_Value_d14; |
| 4471 | |
| 4472 | /* BusCreator: '<S208>/Bus Creator1' */ |
| 4473 | fusionAlg_B.radarObj.radar_05_obj.objObstacleProb = |
| 4474 | *rtu_Radar410_Info_st_x54_24_O_e; |
| 4475 | fusionAlg_B.radarObj.radar_05_obj.objXPos_Stdev = |
| 4476 | *rtu_Radar410_Info_st_x54_24__hl; |
| 4477 | fusionAlg_B.radarObj.radar_05_obj.objYPos_Stdev = |
| 4478 | *rtu_Radar410_Info_st_x54_24_O_h; |
| 4479 | fusionAlg_B.radarObj.radar_05_obj.objXVelRel_Stdev = |
| 4480 | *rtu_Radar410_Info_st_x54_24_O_j; |
| 4481 | fusionAlg_B.radarObj.radar_05_obj.objXAccRel = |
| 4482 | *rtu_Radar410_Info_st_x54_24_O_l; |
| 4483 | fusionAlg_B.radarObj.radar_05_obj.objExstProb = |
| 4484 | *rtu_Radar410_Info_st_x54_24_Obj; |
| 4485 | fusionAlg_B.radarObj.radar_05_obj.objYVelRel = |
| 4486 | *rtu_Radar410_Info_st_x54_24_O_a; |
| 4487 | fusionAlg_B.radarObj.radar_05_obj.objXVelRel = |
| 4488 | *rtu_Radar410_Info_st_x54_24__ir; |
| 4489 | fusionAlg_B.radarObj.radar_05_obj.objXPos = *rtu_Radar410_Info_st_x54_24_O_i; |
| 4490 | fusionAlg_B.radarObj.radar_05_obj.objYPos = *rtu_Radar410_Info_st_x54_24__ba; |
| 4491 | |
| 4492 | /* DataTypeConversion: '<S217>/Data Type Conversion' */ |
| 4493 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x55_25_O_a); |
| 4494 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4495 | tmp = 0.0F; |
| 4496 | } else { |
| 4497 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 4498 | } |
| 4499 | |
| 4500 | fusionAlg_B.radarObj.radar_06_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 4501 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 4502 | |
| 4503 | /* End of DataTypeConversion: '<S217>/Data Type Conversion' */ |
| 4504 | |
| 4505 | /* DataTypeConversion: '<S217>/Data Type Conversion1' */ |
| 4506 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x55_25_O_f); |
| 4507 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4508 | tmp = 0.0F; |
| 4509 | } else { |
| 4510 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4511 | } |
| 4512 | |
| 4513 | fusionAlg_B.radarObj.radar_06_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 4514 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4515 | |
| 4516 | /* End of DataTypeConversion: '<S217>/Data Type Conversion1' */ |
| 4517 | |
| 4518 | /* DataTypeConversion: '<S217>/Data Type Conversion2' */ |
| 4519 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x55_25_O_l); |
| 4520 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4521 | tmp = 0.0F; |
| 4522 | } else { |
| 4523 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4524 | } |
| 4525 | |
| 4526 | fusionAlg_B.radarObj.radar_06_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 4527 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4528 | |
| 4529 | /* End of DataTypeConversion: '<S217>/Data Type Conversion2' */ |
| 4530 | |
| 4531 | /* DataTypeConversion: '<S217>/Data Type Conversion3' */ |
| 4532 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x55_25_O_h); |
| 4533 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4534 | tmp = 0.0F; |
| 4535 | } else { |
| 4536 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4537 | } |
| 4538 | |
| 4539 | fusionAlg_B.radarObj.radar_06_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4540 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4541 | |
| 4542 | /* End of DataTypeConversion: '<S217>/Data Type Conversion3' */ |
| 4543 | |
| 4544 | /* DataTypeConversion: '<S217>/Data Type Conversion4' */ |
| 4545 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x55_25__gh); |
| 4546 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4547 | tmp = 0.0F; |
| 4548 | } else { |
| 4549 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4550 | } |
| 4551 | |
| 4552 | fusionAlg_B.radarObj.radar_06_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4553 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4554 | |
| 4555 | /* End of DataTypeConversion: '<S217>/Data Type Conversion4' */ |
| 4556 | |
| 4557 | /* DataTypeConversion: '<S217>/Data Type Conversion5' */ |
| 4558 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x55_25__gz); |
| 4559 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4560 | tmp = 0.0F; |
| 4561 | } else { |
| 4562 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4563 | } |
| 4564 | |
| 4565 | fusionAlg_B.radarObj.radar_06_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4566 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4567 | |
| 4568 | /* End of DataTypeConversion: '<S217>/Data Type Conversion5' */ |
| 4569 | |
| 4570 | /* BusCreator: '<S217>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4571 | * Constant: '<S217>/Constant' |
| 4572 | * Constant: '<S217>/Constant1' |
| 4573 | */ |
| 4574 | fusionAlg_B.radarObj.radar_06_obj.reserved.reserved1 = |
| 4575 | fusionAlg_P_g.Constant_Value_cd; |
| 4576 | fusionAlg_B.radarObj.radar_06_obj.reserved.reserved0 = |
| 4577 | fusionAlg_P_g.Constant1_Value_ir; |
| 4578 | |
| 4579 | /* BusCreator: '<S217>/Bus Creator1' */ |
| 4580 | fusionAlg_B.radarObj.radar_06_obj.objObstacleProb = |
| 4581 | *rtu_Radar410_Info_st_x55_25_O_i; |
| 4582 | fusionAlg_B.radarObj.radar_06_obj.objXPos_Stdev = |
| 4583 | *rtu_Radar410_Info_st_x55_25__go; |
| 4584 | fusionAlg_B.radarObj.radar_06_obj.objYPos_Stdev = |
| 4585 | *rtu_Radar410_Info_st_x55_25_O_b; |
| 4586 | fusionAlg_B.radarObj.radar_06_obj.objXVelRel_Stdev = |
| 4587 | *rtu_Radar410_Info_st_x55_25_O_d; |
| 4588 | fusionAlg_B.radarObj.radar_06_obj.objXAccRel = |
| 4589 | *rtu_Radar410_Info_st_x55_25_O_g; |
| 4590 | fusionAlg_B.radarObj.radar_06_obj.objExstProb = |
| 4591 | *rtu_Radar410_Info_st_x55_25_Obj; |
| 4592 | fusionAlg_B.radarObj.radar_06_obj.objYVelRel = |
| 4593 | *rtu_Radar410_Info_st_x55_25_O_c; |
| 4594 | fusionAlg_B.radarObj.radar_06_obj.objXVelRel = |
| 4595 | *rtu_Radar410_Info_st_x55_25__l2; |
| 4596 | fusionAlg_B.radarObj.radar_06_obj.objXPos = *rtu_Radar410_Info_st_x55_25_O_e; |
| 4597 | fusionAlg_B.radarObj.radar_06_obj.objYPos = *rtu_Radar410_Info_st_x55_25__lr; |
| 4598 | |
| 4599 | /* DataTypeConversion: '<S218>/Data Type Conversion' */ |
| 4600 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x56_26__iq); |
| 4601 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4602 | tmp = 0.0F; |
| 4603 | } else { |
| 4604 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 4605 | } |
| 4606 | |
| 4607 | fusionAlg_B.radarObj.radar_07_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 4608 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 4609 | |
| 4610 | /* End of DataTypeConversion: '<S218>/Data Type Conversion' */ |
| 4611 | |
| 4612 | /* DataTypeConversion: '<S218>/Data Type Conversion1' */ |
| 4613 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x56_26_O_o); |
| 4614 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4615 | tmp = 0.0F; |
| 4616 | } else { |
| 4617 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4618 | } |
| 4619 | |
| 4620 | fusionAlg_B.radarObj.radar_07_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 4621 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4622 | |
| 4623 | /* End of DataTypeConversion: '<S218>/Data Type Conversion1' */ |
| 4624 | |
| 4625 | /* DataTypeConversion: '<S218>/Data Type Conversion2' */ |
| 4626 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x56_26_O_i); |
| 4627 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4628 | tmp = 0.0F; |
| 4629 | } else { |
| 4630 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4631 | } |
| 4632 | |
| 4633 | fusionAlg_B.radarObj.radar_07_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 4634 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4635 | |
| 4636 | /* End of DataTypeConversion: '<S218>/Data Type Conversion2' */ |
| 4637 | |
| 4638 | /* DataTypeConversion: '<S218>/Data Type Conversion3' */ |
| 4639 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x56_26_O_l); |
| 4640 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4641 | tmp = 0.0F; |
| 4642 | } else { |
| 4643 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4644 | } |
| 4645 | |
| 4646 | fusionAlg_B.radarObj.radar_07_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4647 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4648 | |
| 4649 | /* End of DataTypeConversion: '<S218>/Data Type Conversion3' */ |
| 4650 | |
| 4651 | /* DataTypeConversion: '<S218>/Data Type Conversion4' */ |
| 4652 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x56_26__do); |
| 4653 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4654 | tmp = 0.0F; |
| 4655 | } else { |
| 4656 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4657 | } |
| 4658 | |
| 4659 | fusionAlg_B.radarObj.radar_07_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4660 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4661 | |
| 4662 | /* End of DataTypeConversion: '<S218>/Data Type Conversion4' */ |
| 4663 | |
| 4664 | /* DataTypeConversion: '<S218>/Data Type Conversion5' */ |
| 4665 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x56_26__ex); |
| 4666 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4667 | tmp = 0.0F; |
| 4668 | } else { |
| 4669 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4670 | } |
| 4671 | |
| 4672 | fusionAlg_B.radarObj.radar_07_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4673 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4674 | |
| 4675 | /* End of DataTypeConversion: '<S218>/Data Type Conversion5' */ |
| 4676 | |
| 4677 | /* BusCreator: '<S218>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4678 | * Constant: '<S218>/Constant' |
| 4679 | * Constant: '<S218>/Constant1' |
| 4680 | */ |
| 4681 | fusionAlg_B.radarObj.radar_07_obj.reserved.reserved1 = |
| 4682 | fusionAlg_P_g.Constant_Value_ewi; |
| 4683 | fusionAlg_B.radarObj.radar_07_obj.reserved.reserved0 = |
| 4684 | fusionAlg_P_g.Constant1_Value_hvm; |
| 4685 | |
| 4686 | /* BusCreator: '<S218>/Bus Creator1' */ |
| 4687 | fusionAlg_B.radarObj.radar_07_obj.objObstacleProb = |
| 4688 | *rtu_Radar410_Info_st_x56_26_O_g; |
| 4689 | fusionAlg_B.radarObj.radar_07_obj.objXPos_Stdev = |
| 4690 | *rtu_Radar410_Info_st_x56_26_O_a; |
| 4691 | fusionAlg_B.radarObj.radar_07_obj.objYPos_Stdev = |
| 4692 | *rtu_Radar410_Info_st_x56_26_O_b; |
| 4693 | fusionAlg_B.radarObj.radar_07_obj.objXVelRel_Stdev = |
| 4694 | *rtu_Radar410_Info_st_x56_26_O_e; |
| 4695 | fusionAlg_B.radarObj.radar_07_obj.objXAccRel = |
| 4696 | *rtu_Radar410_Info_st_x56_26_O_c; |
| 4697 | fusionAlg_B.radarObj.radar_07_obj.objExstProb = |
| 4698 | *rtu_Radar410_Info_st_x56_26_Obj; |
| 4699 | fusionAlg_B.radarObj.radar_07_obj.objYVelRel = |
| 4700 | *rtu_Radar410_Info_st_x56_26_O_d; |
| 4701 | fusionAlg_B.radarObj.radar_07_obj.objXVelRel = |
| 4702 | *rtu_Radar410_Info_st_x56_26_O_n; |
| 4703 | fusionAlg_B.radarObj.radar_07_obj.objXPos = *rtu_Radar410_Info_st_x56_26__lj; |
| 4704 | fusionAlg_B.radarObj.radar_07_obj.objYPos = *rtu_Radar410_Info_st_x56_26_O_k; |
| 4705 | |
| 4706 | /* DataTypeConversion: '<S219>/Data Type Conversion' */ |
| 4707 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x57_27_O_o); |
| 4708 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4709 | tmp = 0.0F; |
| 4710 | } else { |
| 4711 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 4712 | } |
| 4713 | |
| 4714 | fusionAlg_B.radarObj.radar_08_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 4715 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 4716 | |
| 4717 | /* End of DataTypeConversion: '<S219>/Data Type Conversion' */ |
| 4718 | |
| 4719 | /* DataTypeConversion: '<S219>/Data Type Conversion1' */ |
| 4720 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x57_27__al); |
| 4721 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4722 | tmp = 0.0F; |
| 4723 | } else { |
| 4724 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4725 | } |
| 4726 | |
| 4727 | fusionAlg_B.radarObj.radar_08_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 4728 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4729 | |
| 4730 | /* End of DataTypeConversion: '<S219>/Data Type Conversion1' */ |
| 4731 | |
| 4732 | /* DataTypeConversion: '<S219>/Data Type Conversion2' */ |
| 4733 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x57_27__iu); |
| 4734 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4735 | tmp = 0.0F; |
| 4736 | } else { |
| 4737 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4738 | } |
| 4739 | |
| 4740 | fusionAlg_B.radarObj.radar_08_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 4741 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4742 | |
| 4743 | /* End of DataTypeConversion: '<S219>/Data Type Conversion2' */ |
| 4744 | |
| 4745 | /* DataTypeConversion: '<S219>/Data Type Conversion3' */ |
| 4746 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x57_27_O_a); |
| 4747 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4748 | tmp = 0.0F; |
| 4749 | } else { |
| 4750 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4751 | } |
| 4752 | |
| 4753 | fusionAlg_B.radarObj.radar_08_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4754 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4755 | |
| 4756 | /* End of DataTypeConversion: '<S219>/Data Type Conversion3' */ |
| 4757 | |
| 4758 | /* DataTypeConversion: '<S219>/Data Type Conversion4' */ |
| 4759 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x57_27_O_e); |
| 4760 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4761 | tmp = 0.0F; |
| 4762 | } else { |
| 4763 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4764 | } |
| 4765 | |
| 4766 | fusionAlg_B.radarObj.radar_08_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4767 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4768 | |
| 4769 | /* End of DataTypeConversion: '<S219>/Data Type Conversion4' */ |
| 4770 | |
| 4771 | /* DataTypeConversion: '<S219>/Data Type Conversion5' */ |
| 4772 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x57_27__au); |
| 4773 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4774 | tmp = 0.0F; |
| 4775 | } else { |
| 4776 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4777 | } |
| 4778 | |
| 4779 | fusionAlg_B.radarObj.radar_08_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4780 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4781 | |
| 4782 | /* End of DataTypeConversion: '<S219>/Data Type Conversion5' */ |
| 4783 | |
| 4784 | /* BusCreator: '<S219>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4785 | * Constant: '<S219>/Constant' |
| 4786 | * Constant: '<S219>/Constant1' |
| 4787 | */ |
| 4788 | fusionAlg_B.radarObj.radar_08_obj.reserved.reserved1 = |
| 4789 | fusionAlg_P_g.Constant_Value_fj; |
| 4790 | fusionAlg_B.radarObj.radar_08_obj.reserved.reserved0 = |
| 4791 | fusionAlg_P_g.Constant1_Value_jv; |
| 4792 | |
| 4793 | /* BusCreator: '<S219>/Bus Creator1' */ |
| 4794 | fusionAlg_B.radarObj.radar_08_obj.objObstacleProb = |
| 4795 | *rtu_Radar410_Info_st_x57_27_O_l; |
| 4796 | fusionAlg_B.radarObj.radar_08_obj.objXPos_Stdev = |
| 4797 | *rtu_Radar410_Info_st_x57_27_O_n; |
| 4798 | fusionAlg_B.radarObj.radar_08_obj.objYPos_Stdev = |
| 4799 | *rtu_Radar410_Info_st_x57_27_O_i; |
| 4800 | fusionAlg_B.radarObj.radar_08_obj.objXVelRel_Stdev = |
| 4801 | *rtu_Radar410_Info_st_x57_27_O_g; |
| 4802 | fusionAlg_B.radarObj.radar_08_obj.objXAccRel = |
| 4803 | *rtu_Radar410_Info_st_x57_27_O_m; |
| 4804 | fusionAlg_B.radarObj.radar_08_obj.objExstProb = |
| 4805 | *rtu_Radar410_Info_st_x57_27_Obj; |
| 4806 | fusionAlg_B.radarObj.radar_08_obj.objYVelRel = |
| 4807 | *rtu_Radar410_Info_st_x57_27__lc; |
| 4808 | fusionAlg_B.radarObj.radar_08_obj.objXVelRel = |
| 4809 | *rtu_Radar410_Info_st_x57_27_O_h; |
| 4810 | fusionAlg_B.radarObj.radar_08_obj.objXPos = *rtu_Radar410_Info_st_x57_27_O_d; |
| 4811 | fusionAlg_B.radarObj.radar_08_obj.objYPos = *rtu_Radar410_Info_st_x57_27__ga; |
| 4812 | |
| 4813 | /* DataTypeConversion: '<S220>/Data Type Conversion' */ |
| 4814 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x58_28_O_m); |
| 4815 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4816 | tmp = 0.0F; |
| 4817 | } else { |
| 4818 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 4819 | } |
| 4820 | |
| 4821 | fusionAlg_B.radarObj.radar_09_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 4822 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 4823 | |
| 4824 | /* End of DataTypeConversion: '<S220>/Data Type Conversion' */ |
| 4825 | |
| 4826 | /* DataTypeConversion: '<S220>/Data Type Conversion1' */ |
| 4827 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x58_28__kp); |
| 4828 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4829 | tmp = 0.0F; |
| 4830 | } else { |
| 4831 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4832 | } |
| 4833 | |
| 4834 | fusionAlg_B.radarObj.radar_09_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 4835 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4836 | |
| 4837 | /* End of DataTypeConversion: '<S220>/Data Type Conversion1' */ |
| 4838 | |
| 4839 | /* DataTypeConversion: '<S220>/Data Type Conversion2' */ |
| 4840 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x58_28_O_j); |
| 4841 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4842 | tmp = 0.0F; |
| 4843 | } else { |
| 4844 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4845 | } |
| 4846 | |
| 4847 | fusionAlg_B.radarObj.radar_09_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 4848 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4849 | |
| 4850 | /* End of DataTypeConversion: '<S220>/Data Type Conversion2' */ |
| 4851 | |
| 4852 | /* DataTypeConversion: '<S220>/Data Type Conversion3' */ |
| 4853 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x58_28_O_k); |
| 4854 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4855 | tmp = 0.0F; |
| 4856 | } else { |
| 4857 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4858 | } |
| 4859 | |
| 4860 | fusionAlg_B.radarObj.radar_09_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4861 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4862 | |
| 4863 | /* End of DataTypeConversion: '<S220>/Data Type Conversion3' */ |
| 4864 | |
| 4865 | /* DataTypeConversion: '<S220>/Data Type Conversion4' */ |
| 4866 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x58_28_O_a); |
| 4867 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4868 | tmp = 0.0F; |
| 4869 | } else { |
| 4870 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4871 | } |
| 4872 | |
| 4873 | fusionAlg_B.radarObj.radar_09_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4874 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4875 | |
| 4876 | /* End of DataTypeConversion: '<S220>/Data Type Conversion4' */ |
| 4877 | |
| 4878 | /* DataTypeConversion: '<S220>/Data Type Conversion5' */ |
| 4879 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x58_28__ba); |
| 4880 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4881 | tmp = 0.0F; |
| 4882 | } else { |
| 4883 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4884 | } |
| 4885 | |
| 4886 | fusionAlg_B.radarObj.radar_09_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4887 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4888 | |
| 4889 | /* End of DataTypeConversion: '<S220>/Data Type Conversion5' */ |
| 4890 | |
| 4891 | /* BusCreator: '<S220>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4892 | * Constant: '<S220>/Constant' |
| 4893 | * Constant: '<S220>/Constant1' |
| 4894 | */ |
| 4895 | fusionAlg_B.radarObj.radar_09_obj.reserved.reserved1 = |
| 4896 | fusionAlg_P_g.Constant_Value_n5; |
| 4897 | fusionAlg_B.radarObj.radar_09_obj.reserved.reserved0 = |
| 4898 | fusionAlg_P_g.Constant1_Value_aj; |
| 4899 | |
| 4900 | /* BusCreator: '<S220>/Bus Creator1' */ |
| 4901 | fusionAlg_B.radarObj.radar_09_obj.objObstacleProb = |
| 4902 | *rtu_Radar410_Info_st_x58_28_O_n; |
| 4903 | fusionAlg_B.radarObj.radar_09_obj.objXPos_Stdev = |
| 4904 | *rtu_Radar410_Info_st_x58_28__cg; |
| 4905 | fusionAlg_B.radarObj.radar_09_obj.objYPos_Stdev = |
| 4906 | *rtu_Radar410_Info_st_x58_28_O_b; |
| 4907 | fusionAlg_B.radarObj.radar_09_obj.objXVelRel_Stdev = |
| 4908 | *rtu_Radar410_Info_st_x58_28_O_c; |
| 4909 | fusionAlg_B.radarObj.radar_09_obj.objXAccRel = |
| 4910 | *rtu_Radar410_Info_st_x58_28_O_p; |
| 4911 | fusionAlg_B.radarObj.radar_09_obj.objExstProb = |
| 4912 | *rtu_Radar410_Info_st_x58_28_Obj; |
| 4913 | fusionAlg_B.radarObj.radar_09_obj.objYVelRel = |
| 4914 | *rtu_Radar410_Info_st_x58_28__kd; |
| 4915 | fusionAlg_B.radarObj.radar_09_obj.objXVelRel = |
| 4916 | *rtu_Radar410_Info_st_x58_28__cb; |
| 4917 | fusionAlg_B.radarObj.radar_09_obj.objXPos = *rtu_Radar410_Info_st_x58_28_O_d; |
| 4918 | fusionAlg_B.radarObj.radar_09_obj.objYPos = *rtu_Radar410_Info_st_x58_28_O_l; |
| 4919 | |
| 4920 | /* DataTypeConversion: '<S221>/Data Type Conversion' */ |
| 4921 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x59_29_O_d); |
| 4922 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4923 | tmp = 0.0F; |
| 4924 | } else { |
| 4925 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 4926 | } |
| 4927 | |
| 4928 | fusionAlg_B.radarObj.radar_10_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 4929 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 4930 | |
| 4931 | /* End of DataTypeConversion: '<S221>/Data Type Conversion' */ |
| 4932 | |
| 4933 | /* DataTypeConversion: '<S221>/Data Type Conversion1' */ |
| 4934 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x59_29_O_i); |
| 4935 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4936 | tmp = 0.0F; |
| 4937 | } else { |
| 4938 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4939 | } |
| 4940 | |
| 4941 | fusionAlg_B.radarObj.radar_10_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 4942 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4943 | |
| 4944 | /* End of DataTypeConversion: '<S221>/Data Type Conversion1' */ |
| 4945 | |
| 4946 | /* DataTypeConversion: '<S221>/Data Type Conversion2' */ |
| 4947 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x59_29_O_n); |
| 4948 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4949 | tmp = 0.0F; |
| 4950 | } else { |
| 4951 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4952 | } |
| 4953 | |
| 4954 | fusionAlg_B.radarObj.radar_10_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 4955 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4956 | |
| 4957 | /* End of DataTypeConversion: '<S221>/Data Type Conversion2' */ |
| 4958 | |
| 4959 | /* DataTypeConversion: '<S221>/Data Type Conversion3' */ |
| 4960 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x59_29_O_b); |
| 4961 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4962 | tmp = 0.0F; |
| 4963 | } else { |
| 4964 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4965 | } |
| 4966 | |
| 4967 | fusionAlg_B.radarObj.radar_10_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 4968 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4969 | |
| 4970 | /* End of DataTypeConversion: '<S221>/Data Type Conversion3' */ |
| 4971 | |
| 4972 | /* DataTypeConversion: '<S221>/Data Type Conversion4' */ |
| 4973 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x59_29__nw); |
| 4974 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4975 | tmp = 0.0F; |
| 4976 | } else { |
| 4977 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4978 | } |
| 4979 | |
| 4980 | fusionAlg_B.radarObj.radar_10_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 4981 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4982 | |
| 4983 | /* End of DataTypeConversion: '<S221>/Data Type Conversion4' */ |
| 4984 | |
| 4985 | /* DataTypeConversion: '<S221>/Data Type Conversion5' */ |
| 4986 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x59_29__iz); |
| 4987 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 4988 | tmp = 0.0F; |
| 4989 | } else { |
| 4990 | tmp = (real32_T)fmod(tmp, 256.0); |
| 4991 | } |
| 4992 | |
| 4993 | fusionAlg_B.radarObj.radar_10_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 4994 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 4995 | |
| 4996 | /* End of DataTypeConversion: '<S221>/Data Type Conversion5' */ |
| 4997 | |
| 4998 | /* BusCreator: '<S221>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 4999 | * Constant: '<S221>/Constant' |
| 5000 | * Constant: '<S221>/Constant1' |
| 5001 | */ |
| 5002 | fusionAlg_B.radarObj.radar_10_obj.reserved.reserved1 = |
| 5003 | fusionAlg_P_g.Constant_Value_ik; |
| 5004 | fusionAlg_B.radarObj.radar_10_obj.reserved.reserved0 = |
| 5005 | fusionAlg_P_g.Constant1_Value_bz; |
| 5006 | |
| 5007 | /* BusCreator: '<S221>/Bus Creator1' */ |
| 5008 | fusionAlg_B.radarObj.radar_10_obj.objObstacleProb = |
| 5009 | *rtu_Radar410_Info_st_x59_29_O_g; |
| 5010 | fusionAlg_B.radarObj.radar_10_obj.objXPos_Stdev = |
| 5011 | *rtu_Radar410_Info_st_x59_29__a1; |
| 5012 | fusionAlg_B.radarObj.radar_10_obj.objYPos_Stdev = |
| 5013 | *rtu_Radar410_Info_st_x59_29_O_a; |
| 5014 | fusionAlg_B.radarObj.radar_10_obj.objXVelRel_Stdev = |
| 5015 | *rtu_Radar410_Info_st_x59_29_O_o; |
| 5016 | fusionAlg_B.radarObj.radar_10_obj.objXAccRel = |
| 5017 | *rtu_Radar410_Info_st_x59_29_O_m; |
| 5018 | fusionAlg_B.radarObj.radar_10_obj.objExstProb = |
| 5019 | *rtu_Radar410_Info_st_x59_29_Obj; |
| 5020 | fusionAlg_B.radarObj.radar_10_obj.objYVelRel = |
| 5021 | *rtu_Radar410_Info_st_x59_29__nl; |
| 5022 | fusionAlg_B.radarObj.radar_10_obj.objXVelRel = |
| 5023 | *rtu_Radar410_Info_st_x59_29__ac; |
| 5024 | fusionAlg_B.radarObj.radar_10_obj.objXPos = *rtu_Radar410_Info_st_x59_29_O_j; |
| 5025 | fusionAlg_B.radarObj.radar_10_obj.objYPos = *rtu_Radar410_Info_st_x59_29_O_k; |
| 5026 | |
| 5027 | /* DataTypeConversion: '<S183>/Data Type Conversion' */ |
| 5028 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5A_2A_O_b); |
| 5029 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5030 | tmp = 0.0F; |
| 5031 | } else { |
| 5032 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5033 | } |
| 5034 | |
| 5035 | fusionAlg_B.radarObj.radar_11_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5036 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 5037 | |
| 5038 | /* End of DataTypeConversion: '<S183>/Data Type Conversion' */ |
| 5039 | |
| 5040 | /* DataTypeConversion: '<S183>/Data Type Conversion1' */ |
| 5041 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5A_2A_O_a); |
| 5042 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5043 | tmp = 0.0F; |
| 5044 | } else { |
| 5045 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5046 | } |
| 5047 | |
| 5048 | fusionAlg_B.radarObj.radar_11_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 5049 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5050 | |
| 5051 | /* End of DataTypeConversion: '<S183>/Data Type Conversion1' */ |
| 5052 | |
| 5053 | /* DataTypeConversion: '<S183>/Data Type Conversion2' */ |
| 5054 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5A_2A_O_p); |
| 5055 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5056 | tmp = 0.0F; |
| 5057 | } else { |
| 5058 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5059 | } |
| 5060 | |
| 5061 | fusionAlg_B.radarObj.radar_11_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 5062 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5063 | |
| 5064 | /* End of DataTypeConversion: '<S183>/Data Type Conversion2' */ |
| 5065 | |
| 5066 | /* DataTypeConversion: '<S183>/Data Type Conversion3' */ |
| 5067 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5A_2A_O_i); |
| 5068 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5069 | tmp = 0.0F; |
| 5070 | } else { |
| 5071 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5072 | } |
| 5073 | |
| 5074 | fusionAlg_B.radarObj.radar_11_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 5075 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5076 | |
| 5077 | /* End of DataTypeConversion: '<S183>/Data Type Conversion3' */ |
| 5078 | |
| 5079 | /* DataTypeConversion: '<S183>/Data Type Conversion4' */ |
| 5080 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5A_2A__l5); |
| 5081 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5082 | tmp = 0.0F; |
| 5083 | } else { |
| 5084 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5085 | } |
| 5086 | |
| 5087 | fusionAlg_B.radarObj.radar_11_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 5088 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5089 | |
| 5090 | /* End of DataTypeConversion: '<S183>/Data Type Conversion4' */ |
| 5091 | |
| 5092 | /* DataTypeConversion: '<S183>/Data Type Conversion5' */ |
| 5093 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5A_2A__nw); |
| 5094 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5095 | tmp = 0.0F; |
| 5096 | } else { |
| 5097 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5098 | } |
| 5099 | |
| 5100 | fusionAlg_B.radarObj.radar_11_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 5101 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5102 | |
| 5103 | /* End of DataTypeConversion: '<S183>/Data Type Conversion5' */ |
| 5104 | |
| 5105 | /* BusCreator: '<S183>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 5106 | * Constant: '<S183>/Constant' |
| 5107 | * Constant: '<S183>/Constant1' |
| 5108 | */ |
| 5109 | fusionAlg_B.radarObj.radar_11_obj.reserved.reserved1 = |
| 5110 | fusionAlg_P_g.Constant_Value_eh; |
| 5111 | fusionAlg_B.radarObj.radar_11_obj.reserved.reserved0 = |
| 5112 | fusionAlg_P_g.Constant1_Value_kl; |
| 5113 | |
| 5114 | /* BusCreator: '<S183>/Bus Creator1' */ |
| 5115 | fusionAlg_B.radarObj.radar_11_obj.objObstacleProb = |
| 5116 | *rtu_Radar410_Info_st_x5A_2A_O_d; |
| 5117 | fusionAlg_B.radarObj.radar_11_obj.objXPos_Stdev = |
| 5118 | *rtu_Radar410_Info_st_x5A_2A_O_n; |
| 5119 | fusionAlg_B.radarObj.radar_11_obj.objYPos_Stdev = |
| 5120 | *rtu_Radar410_Info_st_x5A_2A__dp; |
| 5121 | fusionAlg_B.radarObj.radar_11_obj.objXVelRel_Stdev = |
| 5122 | *rtu_Radar410_Info_st_x5A_2A_O_k; |
| 5123 | fusionAlg_B.radarObj.radar_11_obj.objXAccRel = |
| 5124 | *rtu_Radar410_Info_st_x5A_2A_O_l; |
| 5125 | fusionAlg_B.radarObj.radar_11_obj.objExstProb = |
| 5126 | *rtu_Radar410_Info_st_x5A_2A_Obj; |
| 5127 | fusionAlg_B.radarObj.radar_11_obj.objYVelRel = |
| 5128 | *rtu_Radar410_Info_st_x5A_2A_O_j; |
| 5129 | fusionAlg_B.radarObj.radar_11_obj.objXVelRel = |
| 5130 | *rtu_Radar410_Info_st_x5A_2A__jl; |
| 5131 | fusionAlg_B.radarObj.radar_11_obj.objXPos = *rtu_Radar410_Info_st_x5A_2A__bg; |
| 5132 | fusionAlg_B.radarObj.radar_11_obj.objYPos = *rtu_Radar410_Info_st_x5A_2A__ai; |
| 5133 | |
| 5134 | /* DataTypeConversion: '<S184>/Data Type Conversion' */ |
| 5135 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5B_2B__e5); |
| 5136 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5137 | tmp = 0.0F; |
| 5138 | } else { |
| 5139 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5140 | } |
| 5141 | |
| 5142 | fusionAlg_B.radarObj.radar_12_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5143 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 5144 | |
| 5145 | /* End of DataTypeConversion: '<S184>/Data Type Conversion' */ |
| 5146 | |
| 5147 | /* DataTypeConversion: '<S184>/Data Type Conversion1' */ |
| 5148 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5B_2B_O_h); |
| 5149 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5150 | tmp = 0.0F; |
| 5151 | } else { |
| 5152 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5153 | } |
| 5154 | |
| 5155 | fusionAlg_B.radarObj.radar_12_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 5156 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5157 | |
| 5158 | /* End of DataTypeConversion: '<S184>/Data Type Conversion1' */ |
| 5159 | |
| 5160 | /* DataTypeConversion: '<S184>/Data Type Conversion2' */ |
| 5161 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5B_2B_O_b); |
| 5162 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5163 | tmp = 0.0F; |
| 5164 | } else { |
| 5165 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5166 | } |
| 5167 | |
| 5168 | fusionAlg_B.radarObj.radar_12_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 5169 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5170 | |
| 5171 | /* End of DataTypeConversion: '<S184>/Data Type Conversion2' */ |
| 5172 | |
| 5173 | /* DataTypeConversion: '<S184>/Data Type Conversion3' */ |
| 5174 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5B_2B_O_e); |
| 5175 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5176 | tmp = 0.0F; |
| 5177 | } else { |
| 5178 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5179 | } |
| 5180 | |
| 5181 | fusionAlg_B.radarObj.radar_12_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 5182 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5183 | |
| 5184 | /* End of DataTypeConversion: '<S184>/Data Type Conversion3' */ |
| 5185 | |
| 5186 | /* DataTypeConversion: '<S184>/Data Type Conversion4' */ |
| 5187 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5B_2B__a0); |
| 5188 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5189 | tmp = 0.0F; |
| 5190 | } else { |
| 5191 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5192 | } |
| 5193 | |
| 5194 | fusionAlg_B.radarObj.radar_12_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 5195 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5196 | |
| 5197 | /* End of DataTypeConversion: '<S184>/Data Type Conversion4' */ |
| 5198 | |
| 5199 | /* DataTypeConversion: '<S184>/Data Type Conversion5' */ |
| 5200 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5B_2B_O_g); |
| 5201 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5202 | tmp = 0.0F; |
| 5203 | } else { |
| 5204 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5205 | } |
| 5206 | |
| 5207 | fusionAlg_B.radarObj.radar_12_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 5208 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5209 | |
| 5210 | /* End of DataTypeConversion: '<S184>/Data Type Conversion5' */ |
| 5211 | |
| 5212 | /* BusCreator: '<S184>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 5213 | * Constant: '<S184>/Constant' |
| 5214 | * Constant: '<S184>/Constant1' |
| 5215 | */ |
| 5216 | fusionAlg_B.radarObj.radar_12_obj.reserved.reserved1 = |
| 5217 | fusionAlg_P_g.Constant_Value_d2f; |
| 5218 | fusionAlg_B.radarObj.radar_12_obj.reserved.reserved0 = |
| 5219 | fusionAlg_P_g.Constant1_Value_oq4; |
| 5220 | |
| 5221 | /* BusCreator: '<S184>/Bus Creator1' */ |
| 5222 | fusionAlg_B.radarObj.radar_12_obj.objObstacleProb = |
| 5223 | *rtu_Radar410_Info_st_x5B_2B__aw; |
| 5224 | fusionAlg_B.radarObj.radar_12_obj.objXPos_Stdev = |
| 5225 | *rtu_Radar410_Info_st_x5B_2B_O_k; |
| 5226 | fusionAlg_B.radarObj.radar_12_obj.objYPos_Stdev = |
| 5227 | *rtu_Radar410_Info_st_x5B_2B_O_p; |
| 5228 | fusionAlg_B.radarObj.radar_12_obj.objXVelRel_Stdev = |
| 5229 | *rtu_Radar410_Info_st_x5B_2B_O_f; |
| 5230 | fusionAlg_B.radarObj.radar_12_obj.objXAccRel = |
| 5231 | *rtu_Radar410_Info_st_x5B_2B_O_a; |
| 5232 | fusionAlg_B.radarObj.radar_12_obj.objExstProb = |
| 5233 | *rtu_Radar410_Info_st_x5B_2B_Obj; |
| 5234 | fusionAlg_B.radarObj.radar_12_obj.objYVelRel = |
| 5235 | *rtu_Radar410_Info_st_x5B_2B_O_d; |
| 5236 | fusionAlg_B.radarObj.radar_12_obj.objXVelRel = |
| 5237 | *rtu_Radar410_Info_st_x5B_2B__f2; |
| 5238 | fusionAlg_B.radarObj.radar_12_obj.objXPos = *rtu_Radar410_Info_st_x5B_2B_O_i; |
| 5239 | fusionAlg_B.radarObj.radar_12_obj.objYPos = *rtu_Radar410_Info_st_x5B_2B__iz; |
| 5240 | |
| 5241 | /* DataTypeConversion: '<S185>/Data Type Conversion' */ |
| 5242 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5C_2C_O_f); |
| 5243 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5244 | tmp = 0.0F; |
| 5245 | } else { |
| 5246 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5247 | } |
| 5248 | |
| 5249 | fusionAlg_B.radarObj.radar_13_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5250 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 5251 | |
| 5252 | /* End of DataTypeConversion: '<S185>/Data Type Conversion' */ |
| 5253 | |
| 5254 | /* DataTypeConversion: '<S185>/Data Type Conversion1' */ |
| 5255 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5C_2C__gm); |
| 5256 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5257 | tmp = 0.0F; |
| 5258 | } else { |
| 5259 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5260 | } |
| 5261 | |
| 5262 | fusionAlg_B.radarObj.radar_13_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 5263 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5264 | |
| 5265 | /* End of DataTypeConversion: '<S185>/Data Type Conversion1' */ |
| 5266 | |
| 5267 | /* DataTypeConversion: '<S185>/Data Type Conversion2' */ |
| 5268 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5C_2C__lo); |
| 5269 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5270 | tmp = 0.0F; |
| 5271 | } else { |
| 5272 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5273 | } |
| 5274 | |
| 5275 | fusionAlg_B.radarObj.radar_13_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 5276 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5277 | |
| 5278 | /* End of DataTypeConversion: '<S185>/Data Type Conversion2' */ |
| 5279 | |
| 5280 | /* DataTypeConversion: '<S185>/Data Type Conversion3' */ |
| 5281 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5C_2C__la); |
| 5282 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5283 | tmp = 0.0F; |
| 5284 | } else { |
| 5285 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5286 | } |
| 5287 | |
| 5288 | fusionAlg_B.radarObj.radar_13_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 5289 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5290 | |
| 5291 | /* End of DataTypeConversion: '<S185>/Data Type Conversion3' */ |
| 5292 | |
| 5293 | /* DataTypeConversion: '<S185>/Data Type Conversion4' */ |
| 5294 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5C_2C__fk); |
| 5295 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5296 | tmp = 0.0F; |
| 5297 | } else { |
| 5298 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5299 | } |
| 5300 | |
| 5301 | fusionAlg_B.radarObj.radar_13_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 5302 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5303 | |
| 5304 | /* End of DataTypeConversion: '<S185>/Data Type Conversion4' */ |
| 5305 | |
| 5306 | /* DataTypeConversion: '<S185>/Data Type Conversion5' */ |
| 5307 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5C_2C_O_o); |
| 5308 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5309 | tmp = 0.0F; |
| 5310 | } else { |
| 5311 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5312 | } |
| 5313 | |
| 5314 | fusionAlg_B.radarObj.radar_13_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 5315 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5316 | |
| 5317 | /* End of DataTypeConversion: '<S185>/Data Type Conversion5' */ |
| 5318 | |
| 5319 | /* BusCreator: '<S185>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 5320 | * Constant: '<S185>/Constant' |
| 5321 | * Constant: '<S185>/Constant1' |
| 5322 | */ |
| 5323 | fusionAlg_B.radarObj.radar_13_obj.reserved.reserved1 = |
| 5324 | fusionAlg_P_g.Constant_Value_no2; |
| 5325 | fusionAlg_B.radarObj.radar_13_obj.reserved.reserved0 = |
| 5326 | fusionAlg_P_g.Constant1_Value_ph; |
| 5327 | |
| 5328 | /* BusCreator: '<S185>/Bus Creator1' */ |
| 5329 | fusionAlg_B.radarObj.radar_13_obj.objObstacleProb = |
| 5330 | *rtu_Radar410_Info_st_x5C_2C_O_l; |
| 5331 | fusionAlg_B.radarObj.radar_13_obj.objXPos_Stdev = |
| 5332 | *rtu_Radar410_Info_st_x5C_2C_O_g; |
| 5333 | fusionAlg_B.radarObj.radar_13_obj.objYPos_Stdev = |
| 5334 | *rtu_Radar410_Info_st_x5C_2C_O_k; |
| 5335 | fusionAlg_B.radarObj.radar_13_obj.objXVelRel_Stdev = |
| 5336 | *rtu_Radar410_Info_st_x5C_2C_O_b; |
| 5337 | fusionAlg_B.radarObj.radar_13_obj.objXAccRel = |
| 5338 | *rtu_Radar410_Info_st_x5C_2C_O_h; |
| 5339 | fusionAlg_B.radarObj.radar_13_obj.objExstProb = |
| 5340 | *rtu_Radar410_Info_st_x5C_2C_Obj; |
| 5341 | fusionAlg_B.radarObj.radar_13_obj.objYVelRel = |
| 5342 | *rtu_Radar410_Info_st_x5C_2C_O_i; |
| 5343 | fusionAlg_B.radarObj.radar_13_obj.objXVelRel = |
| 5344 | *rtu_Radar410_Info_st_x5C_2C__oq; |
| 5345 | fusionAlg_B.radarObj.radar_13_obj.objXPos = *rtu_Radar410_Info_st_x5C_2C__i3; |
| 5346 | fusionAlg_B.radarObj.radar_13_obj.objYPos = *rtu_Radar410_Info_st_x5C_2C_O_a; |
| 5347 | |
| 5348 | /* DataTypeConversion: '<S186>/Data Type Conversion' */ |
| 5349 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5D_2D__on); |
| 5350 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5351 | tmp = 0.0F; |
| 5352 | } else { |
| 5353 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5354 | } |
| 5355 | |
| 5356 | fusionAlg_B.radarObj.radar_14_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5357 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 5358 | |
| 5359 | /* End of DataTypeConversion: '<S186>/Data Type Conversion' */ |
| 5360 | |
| 5361 | /* DataTypeConversion: '<S186>/Data Type Conversion1' */ |
| 5362 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5D_2D__hf); |
| 5363 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5364 | tmp = 0.0F; |
| 5365 | } else { |
| 5366 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5367 | } |
| 5368 | |
| 5369 | fusionAlg_B.radarObj.radar_14_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 5370 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5371 | |
| 5372 | /* End of DataTypeConversion: '<S186>/Data Type Conversion1' */ |
| 5373 | |
| 5374 | /* DataTypeConversion: '<S186>/Data Type Conversion2' */ |
| 5375 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5D_2D__no); |
| 5376 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5377 | tmp = 0.0F; |
| 5378 | } else { |
| 5379 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5380 | } |
| 5381 | |
| 5382 | fusionAlg_B.radarObj.radar_14_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 5383 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5384 | |
| 5385 | /* End of DataTypeConversion: '<S186>/Data Type Conversion2' */ |
| 5386 | |
| 5387 | /* DataTypeConversion: '<S186>/Data Type Conversion3' */ |
| 5388 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5D_2D_O_h); |
| 5389 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5390 | tmp = 0.0F; |
| 5391 | } else { |
| 5392 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5393 | } |
| 5394 | |
| 5395 | fusionAlg_B.radarObj.radar_14_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 5396 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5397 | |
| 5398 | /* End of DataTypeConversion: '<S186>/Data Type Conversion3' */ |
| 5399 | |
| 5400 | /* DataTypeConversion: '<S186>/Data Type Conversion4' */ |
| 5401 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5D_2D_O_g); |
| 5402 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5403 | tmp = 0.0F; |
| 5404 | } else { |
| 5405 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5406 | } |
| 5407 | |
| 5408 | fusionAlg_B.radarObj.radar_14_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 5409 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5410 | |
| 5411 | /* End of DataTypeConversion: '<S186>/Data Type Conversion4' */ |
| 5412 | |
| 5413 | /* DataTypeConversion: '<S186>/Data Type Conversion5' */ |
| 5414 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5D_2D_O_j); |
| 5415 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5416 | tmp = 0.0F; |
| 5417 | } else { |
| 5418 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5419 | } |
| 5420 | |
| 5421 | fusionAlg_B.radarObj.radar_14_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 5422 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5423 | |
| 5424 | /* End of DataTypeConversion: '<S186>/Data Type Conversion5' */ |
| 5425 | |
| 5426 | /* BusCreator: '<S186>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 5427 | * Constant: '<S186>/Constant' |
| 5428 | * Constant: '<S186>/Constant1' |
| 5429 | */ |
| 5430 | fusionAlg_B.radarObj.radar_14_obj.reserved.reserved1 = |
| 5431 | fusionAlg_P_g.Constant_Value_ek; |
| 5432 | fusionAlg_B.radarObj.radar_14_obj.reserved.reserved0 = |
| 5433 | fusionAlg_P_g.Constant1_Value_bb; |
| 5434 | |
| 5435 | /* BusCreator: '<S186>/Bus Creator1' */ |
| 5436 | fusionAlg_B.radarObj.radar_14_obj.objObstacleProb = |
| 5437 | *rtu_Radar410_Info_st_x5D_2D_O_o; |
| 5438 | fusionAlg_B.radarObj.radar_14_obj.objXPos_Stdev = |
| 5439 | *rtu_Radar410_Info_st_x5D_2D_O_c; |
| 5440 | fusionAlg_B.radarObj.radar_14_obj.objYPos_Stdev = |
| 5441 | *rtu_Radar410_Info_st_x5D_2D_O_n; |
| 5442 | fusionAlg_B.radarObj.radar_14_obj.objXVelRel_Stdev = |
| 5443 | *rtu_Radar410_Info_st_x5D_2D_O_e; |
| 5444 | fusionAlg_B.radarObj.radar_14_obj.objXAccRel = |
| 5445 | *rtu_Radar410_Info_st_x5D_2D_O_p; |
| 5446 | fusionAlg_B.radarObj.radar_14_obj.objExstProb = |
| 5447 | *rtu_Radar410_Info_st_x5D_2D_Obj; |
| 5448 | fusionAlg_B.radarObj.radar_14_obj.objYVelRel = |
| 5449 | *rtu_Radar410_Info_st_x5D_2D_O_l; |
| 5450 | fusionAlg_B.radarObj.radar_14_obj.objXVelRel = |
| 5451 | *rtu_Radar410_Info_st_x5D_2D__hb; |
| 5452 | fusionAlg_B.radarObj.radar_14_obj.objXPos = *rtu_Radar410_Info_st_x5D_2D__gg; |
| 5453 | fusionAlg_B.radarObj.radar_14_obj.objYPos = *rtu_Radar410_Info_st_x5D_2D_O_m; |
| 5454 | |
| 5455 | /* DataTypeConversion: '<S189>/Data Type Conversion' */ |
| 5456 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5E_2E_O_i); |
| 5457 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5458 | tmp = 0.0F; |
| 5459 | } else { |
| 5460 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5461 | } |
| 5462 | |
| 5463 | fusionAlg_B.radarObj.radar_15_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5464 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 5465 | |
| 5466 | /* End of DataTypeConversion: '<S189>/Data Type Conversion' */ |
| 5467 | |
| 5468 | /* DataTypeConversion: '<S189>/Data Type Conversion1' */ |
| 5469 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5E_2E_O_m); |
| 5470 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5471 | tmp = 0.0F; |
| 5472 | } else { |
| 5473 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5474 | } |
| 5475 | |
| 5476 | fusionAlg_B.radarObj.radar_15_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 5477 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5478 | |
| 5479 | /* End of DataTypeConversion: '<S189>/Data Type Conversion1' */ |
| 5480 | |
| 5481 | /* DataTypeConversion: '<S189>/Data Type Conversion2' */ |
| 5482 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5E_2E__gu); |
| 5483 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5484 | tmp = 0.0F; |
| 5485 | } else { |
| 5486 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5487 | } |
| 5488 | |
| 5489 | fusionAlg_B.radarObj.radar_15_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 5490 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5491 | |
| 5492 | /* End of DataTypeConversion: '<S189>/Data Type Conversion2' */ |
| 5493 | |
| 5494 | /* DataTypeConversion: '<S189>/Data Type Conversion3' */ |
| 5495 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5E_2E_O_h); |
| 5496 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5497 | tmp = 0.0F; |
| 5498 | } else { |
| 5499 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5500 | } |
| 5501 | |
| 5502 | fusionAlg_B.radarObj.radar_15_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 5503 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5504 | |
| 5505 | /* End of DataTypeConversion: '<S189>/Data Type Conversion3' */ |
| 5506 | |
| 5507 | /* DataTypeConversion: '<S189>/Data Type Conversion4' */ |
| 5508 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5E_2E__ie); |
| 5509 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5510 | tmp = 0.0F; |
| 5511 | } else { |
| 5512 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5513 | } |
| 5514 | |
| 5515 | fusionAlg_B.radarObj.radar_15_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 5516 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5517 | |
| 5518 | /* End of DataTypeConversion: '<S189>/Data Type Conversion4' */ |
| 5519 | |
| 5520 | /* DataTypeConversion: '<S189>/Data Type Conversion5' */ |
| 5521 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5E_2E__if); |
| 5522 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5523 | tmp = 0.0F; |
| 5524 | } else { |
| 5525 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5526 | } |
| 5527 | |
| 5528 | fusionAlg_B.radarObj.radar_15_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 5529 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5530 | |
| 5531 | /* End of DataTypeConversion: '<S189>/Data Type Conversion5' */ |
| 5532 | |
| 5533 | /* BusCreator: '<S189>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 5534 | * Constant: '<S189>/Constant' |
| 5535 | * Constant: '<S189>/Constant1' |
| 5536 | */ |
| 5537 | fusionAlg_B.radarObj.radar_15_obj.reserved.reserved1 = |
| 5538 | fusionAlg_P_g.Constant_Value_pt; |
| 5539 | fusionAlg_B.radarObj.radar_15_obj.reserved.reserved0 = |
| 5540 | fusionAlg_P_g.Constant1_Value_jd; |
| 5541 | |
| 5542 | /* BusCreator: '<S189>/Bus Creator1' */ |
| 5543 | fusionAlg_B.radarObj.radar_15_obj.objObstacleProb = |
| 5544 | *rtu_Radar410_Info_st_x5E_2E__lx; |
| 5545 | fusionAlg_B.radarObj.radar_15_obj.objXPos_Stdev = |
| 5546 | *rtu_Radar410_Info_st_x5E_2E__gn; |
| 5547 | fusionAlg_B.radarObj.radar_15_obj.objYPos_Stdev = |
| 5548 | *rtu_Radar410_Info_st_x5E_2E__lc; |
| 5549 | fusionAlg_B.radarObj.radar_15_obj.objXVelRel_Stdev = |
| 5550 | *rtu_Radar410_Info_st_x5E_2E_O_l; |
| 5551 | fusionAlg_B.radarObj.radar_15_obj.objXAccRel = |
| 5552 | *rtu_Radar410_Info_st_x5E_2E_O_g; |
| 5553 | fusionAlg_B.radarObj.radar_15_obj.objExstProb = |
| 5554 | *rtu_Radar410_Info_st_x5E_2E_Obj; |
| 5555 | fusionAlg_B.radarObj.radar_15_obj.objYVelRel = |
| 5556 | *rtu_Radar410_Info_st_x5E_2E__l3; |
| 5557 | fusionAlg_B.radarObj.radar_15_obj.objXVelRel = |
| 5558 | *rtu_Radar410_Info_st_x5E_2E_O_f; |
| 5559 | fusionAlg_B.radarObj.radar_15_obj.objXPos = *rtu_Radar410_Info_st_x5E_2E_O_a; |
| 5560 | fusionAlg_B.radarObj.radar_15_obj.objYPos = *rtu_Radar410_Info_st_x5E_2E_O_c; |
| 5561 | |
| 5562 | /* DataTypeConversion: '<S190>/Data Type Conversion' */ |
| 5563 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5F_2F__ds); |
| 5564 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5565 | tmp = 0.0F; |
| 5566 | } else { |
| 5567 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5568 | } |
| 5569 | |
| 5570 | fusionAlg_B.radarObj.radar_16_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5571 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 5572 | |
| 5573 | /* End of DataTypeConversion: '<S190>/Data Type Conversion' */ |
| 5574 | |
| 5575 | /* DataTypeConversion: '<S190>/Data Type Conversion1' */ |
| 5576 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5F_2F_O_j); |
| 5577 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5578 | tmp = 0.0F; |
| 5579 | } else { |
| 5580 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5581 | } |
| 5582 | |
| 5583 | fusionAlg_B.radarObj.radar_16_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 5584 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5585 | |
| 5586 | /* End of DataTypeConversion: '<S190>/Data Type Conversion1' */ |
| 5587 | |
| 5588 | /* DataTypeConversion: '<S190>/Data Type Conversion2' */ |
| 5589 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5F_2F_O_n); |
| 5590 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5591 | tmp = 0.0F; |
| 5592 | } else { |
| 5593 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5594 | } |
| 5595 | |
| 5596 | fusionAlg_B.radarObj.radar_16_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 5597 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5598 | |
| 5599 | /* End of DataTypeConversion: '<S190>/Data Type Conversion2' */ |
| 5600 | |
| 5601 | /* DataTypeConversion: '<S190>/Data Type Conversion3' */ |
| 5602 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5F_2F_O_f); |
| 5603 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5604 | tmp = 0.0F; |
| 5605 | } else { |
| 5606 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5607 | } |
| 5608 | |
| 5609 | fusionAlg_B.radarObj.radar_16_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 5610 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5611 | |
| 5612 | /* End of DataTypeConversion: '<S190>/Data Type Conversion3' */ |
| 5613 | |
| 5614 | /* DataTypeConversion: '<S190>/Data Type Conversion4' */ |
| 5615 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5F_2F__hw); |
| 5616 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5617 | tmp = 0.0F; |
| 5618 | } else { |
| 5619 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5620 | } |
| 5621 | |
| 5622 | fusionAlg_B.radarObj.radar_16_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 5623 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5624 | |
| 5625 | /* End of DataTypeConversion: '<S190>/Data Type Conversion4' */ |
| 5626 | |
| 5627 | /* DataTypeConversion: '<S190>/Data Type Conversion5' */ |
| 5628 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x5F_2F__hh); |
| 5629 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5630 | tmp = 0.0F; |
| 5631 | } else { |
| 5632 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5633 | } |
| 5634 | |
| 5635 | fusionAlg_B.radarObj.radar_16_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 5636 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5637 | |
| 5638 | /* End of DataTypeConversion: '<S190>/Data Type Conversion5' */ |
| 5639 | |
| 5640 | /* BusCreator: '<S190>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 5641 | * Constant: '<S190>/Constant' |
| 5642 | * Constant: '<S190>/Constant1' |
| 5643 | */ |
| 5644 | fusionAlg_B.radarObj.radar_16_obj.reserved.reserved1 = |
| 5645 | fusionAlg_P_g.Constant_Value_pl; |
| 5646 | fusionAlg_B.radarObj.radar_16_obj.reserved.reserved0 = |
| 5647 | fusionAlg_P_g.Constant1_Value_lx; |
| 5648 | |
| 5649 | /* BusCreator: '<S190>/Bus Creator1' */ |
| 5650 | fusionAlg_B.radarObj.radar_16_obj.objObstacleProb = |
| 5651 | *rtu_Radar410_Info_st_x5F_2F_O_h; |
| 5652 | fusionAlg_B.radarObj.radar_16_obj.objXPos_Stdev = |
| 5653 | *rtu_Radar410_Info_st_x5F_2F__fw; |
| 5654 | fusionAlg_B.radarObj.radar_16_obj.objYPos_Stdev = |
| 5655 | *rtu_Radar410_Info_st_x5F_2F_O_e; |
| 5656 | fusionAlg_B.radarObj.radar_16_obj.objXVelRel_Stdev = |
| 5657 | *rtu_Radar410_Info_st_x5F_2F_O_d; |
| 5658 | fusionAlg_B.radarObj.radar_16_obj.objXAccRel = |
| 5659 | *rtu_Radar410_Info_st_x5F_2F_O_g; |
| 5660 | fusionAlg_B.radarObj.radar_16_obj.objExstProb = |
| 5661 | *rtu_Radar410_Info_st_x5F_2F_Obj; |
| 5662 | fusionAlg_B.radarObj.radar_16_obj.objYVelRel = |
| 5663 | *rtu_Radar410_Info_st_x5F_2F_O_o; |
| 5664 | fusionAlg_B.radarObj.radar_16_obj.objXVelRel = |
| 5665 | *rtu_Radar410_Info_st_x5F_2F__oa; |
| 5666 | fusionAlg_B.radarObj.radar_16_obj.objXPos = *rtu_Radar410_Info_st_x5F_2F_O_l; |
| 5667 | fusionAlg_B.radarObj.radar_16_obj.objYPos = *rtu_Radar410_Info_st_x5F_2F_O_c; |
| 5668 | |
| 5669 | /* DataTypeConversion: '<S191>/Data Type Conversion' */ |
| 5670 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x60_30_O_j); |
| 5671 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5672 | tmp = 0.0F; |
| 5673 | } else { |
| 5674 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5675 | } |
| 5676 | |
| 5677 | fusionAlg_B.radarObj.radar_17_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5678 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 5679 | |
| 5680 | /* End of DataTypeConversion: '<S191>/Data Type Conversion' */ |
| 5681 | |
| 5682 | /* DataTypeConversion: '<S191>/Data Type Conversion1' */ |
| 5683 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x60_30_O_l); |
| 5684 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5685 | tmp = 0.0F; |
| 5686 | } else { |
| 5687 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5688 | } |
| 5689 | |
| 5690 | fusionAlg_B.radarObj.radar_17_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 5691 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5692 | |
| 5693 | /* End of DataTypeConversion: '<S191>/Data Type Conversion1' */ |
| 5694 | |
| 5695 | /* DataTypeConversion: '<S191>/Data Type Conversion2' */ |
| 5696 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x60_30__d4); |
| 5697 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5698 | tmp = 0.0F; |
| 5699 | } else { |
| 5700 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5701 | } |
| 5702 | |
| 5703 | fusionAlg_B.radarObj.radar_17_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 5704 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5705 | |
| 5706 | /* End of DataTypeConversion: '<S191>/Data Type Conversion2' */ |
| 5707 | |
| 5708 | /* DataTypeConversion: '<S191>/Data Type Conversion3' */ |
| 5709 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x60_30_O_a); |
| 5710 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5711 | tmp = 0.0F; |
| 5712 | } else { |
| 5713 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5714 | } |
| 5715 | |
| 5716 | fusionAlg_B.radarObj.radar_17_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 5717 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5718 | |
| 5719 | /* End of DataTypeConversion: '<S191>/Data Type Conversion3' */ |
| 5720 | |
| 5721 | /* DataTypeConversion: '<S191>/Data Type Conversion4' */ |
| 5722 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x60_30_O_m); |
| 5723 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5724 | tmp = 0.0F; |
| 5725 | } else { |
| 5726 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5727 | } |
| 5728 | |
| 5729 | fusionAlg_B.radarObj.radar_17_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 5730 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5731 | |
| 5732 | /* End of DataTypeConversion: '<S191>/Data Type Conversion4' */ |
| 5733 | |
| 5734 | /* DataTypeConversion: '<S191>/Data Type Conversion5' */ |
| 5735 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x60_30__jp); |
| 5736 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5737 | tmp = 0.0F; |
| 5738 | } else { |
| 5739 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5740 | } |
| 5741 | |
| 5742 | fusionAlg_B.radarObj.radar_17_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 5743 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5744 | |
| 5745 | /* End of DataTypeConversion: '<S191>/Data Type Conversion5' */ |
| 5746 | |
| 5747 | /* BusCreator: '<S191>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 5748 | * Constant: '<S191>/Constant' |
| 5749 | * Constant: '<S191>/Constant1' |
| 5750 | */ |
| 5751 | fusionAlg_B.radarObj.radar_17_obj.reserved.reserved1 = |
| 5752 | fusionAlg_P_g.Constant_Value_fwm; |
| 5753 | fusionAlg_B.radarObj.radar_17_obj.reserved.reserved0 = |
| 5754 | fusionAlg_P_g.Constant1_Value_an; |
| 5755 | |
| 5756 | /* BusCreator: '<S191>/Bus Creator1' */ |
| 5757 | fusionAlg_B.radarObj.radar_17_obj.objObstacleProb = |
| 5758 | *rtu_Radar410_Info_st_x60_30_O_f; |
| 5759 | fusionAlg_B.radarObj.radar_17_obj.objXPos_Stdev = |
| 5760 | *rtu_Radar410_Info_st_x60_30_O_h; |
| 5761 | fusionAlg_B.radarObj.radar_17_obj.objYPos_Stdev = |
| 5762 | *rtu_Radar410_Info_st_x60_30_O_g; |
| 5763 | fusionAlg_B.radarObj.radar_17_obj.objXVelRel_Stdev = |
| 5764 | *rtu_Radar410_Info_st_x60_30_O_k; |
| 5765 | fusionAlg_B.radarObj.radar_17_obj.objXAccRel = |
| 5766 | *rtu_Radar410_Info_st_x60_30_O_d; |
| 5767 | fusionAlg_B.radarObj.radar_17_obj.objExstProb = |
| 5768 | *rtu_Radar410_Info_st_x60_30_Obj; |
| 5769 | fusionAlg_B.radarObj.radar_17_obj.objYVelRel = |
| 5770 | *rtu_Radar410_Info_st_x60_30_O_e; |
| 5771 | fusionAlg_B.radarObj.radar_17_obj.objXVelRel = |
| 5772 | *rtu_Radar410_Info_st_x60_30_O_p; |
| 5773 | fusionAlg_B.radarObj.radar_17_obj.objXPos = *rtu_Radar410_Info_st_x60_30__ga; |
| 5774 | fusionAlg_B.radarObj.radar_17_obj.objYPos = *rtu_Radar410_Info_st_x60_30__j4; |
| 5775 | |
| 5776 | /* DataTypeConversion: '<S192>/Data Type Conversion' */ |
| 5777 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x61_31_O_a); |
| 5778 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5779 | tmp = 0.0F; |
| 5780 | } else { |
| 5781 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5782 | } |
| 5783 | |
| 5784 | fusionAlg_B.radarObj.radar_18_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5785 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 5786 | |
| 5787 | /* End of DataTypeConversion: '<S192>/Data Type Conversion' */ |
| 5788 | |
| 5789 | /* DataTypeConversion: '<S192>/Data Type Conversion1' */ |
| 5790 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x61_31_O_k); |
| 5791 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5792 | tmp = 0.0F; |
| 5793 | } else { |
| 5794 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5795 | } |
| 5796 | |
| 5797 | fusionAlg_B.radarObj.radar_18_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 5798 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5799 | |
| 5800 | /* End of DataTypeConversion: '<S192>/Data Type Conversion1' */ |
| 5801 | |
| 5802 | /* DataTypeConversion: '<S192>/Data Type Conversion2' */ |
| 5803 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x61_31__mk); |
| 5804 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5805 | tmp = 0.0F; |
| 5806 | } else { |
| 5807 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5808 | } |
| 5809 | |
| 5810 | fusionAlg_B.radarObj.radar_18_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 5811 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5812 | |
| 5813 | /* End of DataTypeConversion: '<S192>/Data Type Conversion2' */ |
| 5814 | |
| 5815 | /* DataTypeConversion: '<S192>/Data Type Conversion3' */ |
| 5816 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x61_31_O_m); |
| 5817 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5818 | tmp = 0.0F; |
| 5819 | } else { |
| 5820 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5821 | } |
| 5822 | |
| 5823 | fusionAlg_B.radarObj.radar_18_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 5824 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5825 | |
| 5826 | /* End of DataTypeConversion: '<S192>/Data Type Conversion3' */ |
| 5827 | |
| 5828 | /* DataTypeConversion: '<S192>/Data Type Conversion4' */ |
| 5829 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x61_31_O_d); |
| 5830 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5831 | tmp = 0.0F; |
| 5832 | } else { |
| 5833 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5834 | } |
| 5835 | |
| 5836 | fusionAlg_B.radarObj.radar_18_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 5837 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5838 | |
| 5839 | /* End of DataTypeConversion: '<S192>/Data Type Conversion4' */ |
| 5840 | |
| 5841 | /* DataTypeConversion: '<S192>/Data Type Conversion5' */ |
| 5842 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x61_31__bg); |
| 5843 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5844 | tmp = 0.0F; |
| 5845 | } else { |
| 5846 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5847 | } |
| 5848 | |
| 5849 | fusionAlg_B.radarObj.radar_18_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 5850 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5851 | |
| 5852 | /* End of DataTypeConversion: '<S192>/Data Type Conversion5' */ |
| 5853 | |
| 5854 | /* BusCreator: '<S192>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 5855 | * Constant: '<S192>/Constant' |
| 5856 | * Constant: '<S192>/Constant1' |
| 5857 | */ |
| 5858 | fusionAlg_B.radarObj.radar_18_obj.reserved.reserved1 = |
| 5859 | fusionAlg_P_g.Constant_Value_md; |
| 5860 | fusionAlg_B.radarObj.radar_18_obj.reserved.reserved0 = |
| 5861 | fusionAlg_P_g.Constant1_Value_ot; |
| 5862 | |
| 5863 | /* BusCreator: '<S192>/Bus Creator1' */ |
| 5864 | fusionAlg_B.radarObj.radar_18_obj.objObstacleProb = |
| 5865 | *rtu_Radar410_Info_st_x61_31_O_l; |
| 5866 | fusionAlg_B.radarObj.radar_18_obj.objXPos_Stdev = |
| 5867 | *rtu_Radar410_Info_st_x61_31_O_n; |
| 5868 | fusionAlg_B.radarObj.radar_18_obj.objYPos_Stdev = |
| 5869 | *rtu_Radar410_Info_st_x61_31_O_f; |
| 5870 | fusionAlg_B.radarObj.radar_18_obj.objXVelRel_Stdev = |
| 5871 | *rtu_Radar410_Info_st_x61_31_O_i; |
| 5872 | fusionAlg_B.radarObj.radar_18_obj.objXAccRel = |
| 5873 | *rtu_Radar410_Info_st_x61_31_O_b; |
| 5874 | fusionAlg_B.radarObj.radar_18_obj.objExstProb = |
| 5875 | *rtu_Radar410_Info_st_x61_31_Obj; |
| 5876 | fusionAlg_B.radarObj.radar_18_obj.objYVelRel = |
| 5877 | *rtu_Radar410_Info_st_x61_31__ir; |
| 5878 | fusionAlg_B.radarObj.radar_18_obj.objXVelRel = |
| 5879 | *rtu_Radar410_Info_st_x61_31__dz; |
| 5880 | fusionAlg_B.radarObj.radar_18_obj.objXPos = *rtu_Radar410_Info_st_x61_31_O_j; |
| 5881 | fusionAlg_B.radarObj.radar_18_obj.objYPos = *rtu_Radar410_Info_st_x61_31__mz; |
| 5882 | |
| 5883 | /* DataTypeConversion: '<S194>/Data Type Conversion' */ |
| 5884 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x62_32_O_a); |
| 5885 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5886 | tmp = 0.0F; |
| 5887 | } else { |
| 5888 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5889 | } |
| 5890 | |
| 5891 | fusionAlg_B.radarObj.radar_19_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5892 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 5893 | |
| 5894 | /* End of DataTypeConversion: '<S194>/Data Type Conversion' */ |
| 5895 | |
| 5896 | /* DataTypeConversion: '<S194>/Data Type Conversion1' */ |
| 5897 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x62_32__ku); |
| 5898 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5899 | tmp = 0.0F; |
| 5900 | } else { |
| 5901 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5902 | } |
| 5903 | |
| 5904 | fusionAlg_B.radarObj.radar_19_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 5905 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5906 | |
| 5907 | /* End of DataTypeConversion: '<S194>/Data Type Conversion1' */ |
| 5908 | |
| 5909 | /* DataTypeConversion: '<S194>/Data Type Conversion2' */ |
| 5910 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x62_32_O_k); |
| 5911 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5912 | tmp = 0.0F; |
| 5913 | } else { |
| 5914 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5915 | } |
| 5916 | |
| 5917 | fusionAlg_B.radarObj.radar_19_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 5918 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5919 | |
| 5920 | /* End of DataTypeConversion: '<S194>/Data Type Conversion2' */ |
| 5921 | |
| 5922 | /* DataTypeConversion: '<S194>/Data Type Conversion3' */ |
| 5923 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x62_32_O_e); |
| 5924 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5925 | tmp = 0.0F; |
| 5926 | } else { |
| 5927 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5928 | } |
| 5929 | |
| 5930 | fusionAlg_B.radarObj.radar_19_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 5931 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5932 | |
| 5933 | /* End of DataTypeConversion: '<S194>/Data Type Conversion3' */ |
| 5934 | |
| 5935 | /* DataTypeConversion: '<S194>/Data Type Conversion4' */ |
| 5936 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x62_32_O_c); |
| 5937 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5938 | tmp = 0.0F; |
| 5939 | } else { |
| 5940 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5941 | } |
| 5942 | |
| 5943 | fusionAlg_B.radarObj.radar_19_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 5944 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5945 | |
| 5946 | /* End of DataTypeConversion: '<S194>/Data Type Conversion4' */ |
| 5947 | |
| 5948 | /* DataTypeConversion: '<S194>/Data Type Conversion5' */ |
| 5949 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x62_32__jk); |
| 5950 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5951 | tmp = 0.0F; |
| 5952 | } else { |
| 5953 | tmp = (real32_T)fmod(tmp, 256.0); |
| 5954 | } |
| 5955 | |
| 5956 | fusionAlg_B.radarObj.radar_19_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 5957 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 5958 | |
| 5959 | /* End of DataTypeConversion: '<S194>/Data Type Conversion5' */ |
| 5960 | |
| 5961 | /* BusCreator: '<S194>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 5962 | * Constant: '<S194>/Constant' |
| 5963 | * Constant: '<S194>/Constant1' |
| 5964 | */ |
| 5965 | fusionAlg_B.radarObj.radar_19_obj.reserved.reserved1 = |
| 5966 | fusionAlg_P_g.Constant_Value_ilp; |
| 5967 | fusionAlg_B.radarObj.radar_19_obj.reserved.reserved0 = |
| 5968 | fusionAlg_P_g.Constant1_Value_hq; |
| 5969 | |
| 5970 | /* BusCreator: '<S194>/Bus Creator1' */ |
| 5971 | fusionAlg_B.radarObj.radar_19_obj.objObstacleProb = |
| 5972 | *rtu_Radar410_Info_st_x62_32__ja; |
| 5973 | fusionAlg_B.radarObj.radar_19_obj.objXPos_Stdev = |
| 5974 | *rtu_Radar410_Info_st_x62_32_O_o; |
| 5975 | fusionAlg_B.radarObj.radar_19_obj.objYPos_Stdev = |
| 5976 | *rtu_Radar410_Info_st_x62_32_O_d; |
| 5977 | fusionAlg_B.radarObj.radar_19_obj.objXVelRel_Stdev = |
| 5978 | *rtu_Radar410_Info_st_x62_32_O_p; |
| 5979 | fusionAlg_B.radarObj.radar_19_obj.objXAccRel = |
| 5980 | *rtu_Radar410_Info_st_x62_32_O_j; |
| 5981 | fusionAlg_B.radarObj.radar_19_obj.objExstProb = |
| 5982 | *rtu_Radar410_Info_st_x62_32_Obj; |
| 5983 | fusionAlg_B.radarObj.radar_19_obj.objYVelRel = |
| 5984 | *rtu_Radar410_Info_st_x62_32_O_m; |
| 5985 | fusionAlg_B.radarObj.radar_19_obj.objXVelRel = |
| 5986 | *rtu_Radar410_Info_st_x62_32_O_i; |
| 5987 | fusionAlg_B.radarObj.radar_19_obj.objXPos = *rtu_Radar410_Info_st_x62_32_O_l; |
| 5988 | fusionAlg_B.radarObj.radar_19_obj.objYPos = *rtu_Radar410_Info_st_x62_32__cz; |
| 5989 | |
| 5990 | /* DataTypeConversion: '<S195>/Data Type Conversion' */ |
| 5991 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x63_33__pi); |
| 5992 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 5993 | tmp = 0.0F; |
| 5994 | } else { |
| 5995 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 5996 | } |
| 5997 | |
| 5998 | fusionAlg_B.radarObj.radar_20_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 5999 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6000 | |
| 6001 | /* End of DataTypeConversion: '<S195>/Data Type Conversion' */ |
| 6002 | |
| 6003 | /* DataTypeConversion: '<S195>/Data Type Conversion1' */ |
| 6004 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x63_33_O_j); |
| 6005 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6006 | tmp = 0.0F; |
| 6007 | } else { |
| 6008 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6009 | } |
| 6010 | |
| 6011 | fusionAlg_B.radarObj.radar_20_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6012 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6013 | |
| 6014 | /* End of DataTypeConversion: '<S195>/Data Type Conversion1' */ |
| 6015 | |
| 6016 | /* DataTypeConversion: '<S195>/Data Type Conversion2' */ |
| 6017 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x63_33_O_p); |
| 6018 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6019 | tmp = 0.0F; |
| 6020 | } else { |
| 6021 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6022 | } |
| 6023 | |
| 6024 | fusionAlg_B.radarObj.radar_20_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6025 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6026 | |
| 6027 | /* End of DataTypeConversion: '<S195>/Data Type Conversion2' */ |
| 6028 | |
| 6029 | /* DataTypeConversion: '<S195>/Data Type Conversion3' */ |
| 6030 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x63_33_O_i); |
| 6031 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6032 | tmp = 0.0F; |
| 6033 | } else { |
| 6034 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6035 | } |
| 6036 | |
| 6037 | fusionAlg_B.radarObj.radar_20_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 6038 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6039 | |
| 6040 | /* End of DataTypeConversion: '<S195>/Data Type Conversion3' */ |
| 6041 | |
| 6042 | /* DataTypeConversion: '<S195>/Data Type Conversion4' */ |
| 6043 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x63_33__k4); |
| 6044 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6045 | tmp = 0.0F; |
| 6046 | } else { |
| 6047 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6048 | } |
| 6049 | |
| 6050 | fusionAlg_B.radarObj.radar_20_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 6051 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6052 | |
| 6053 | /* End of DataTypeConversion: '<S195>/Data Type Conversion4' */ |
| 6054 | |
| 6055 | /* DataTypeConversion: '<S195>/Data Type Conversion5' */ |
| 6056 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x63_33_O_h); |
| 6057 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6058 | tmp = 0.0F; |
| 6059 | } else { |
| 6060 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6061 | } |
| 6062 | |
| 6063 | fusionAlg_B.radarObj.radar_20_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 6064 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6065 | |
| 6066 | /* End of DataTypeConversion: '<S195>/Data Type Conversion5' */ |
| 6067 | |
| 6068 | /* BusCreator: '<S195>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 6069 | * Constant: '<S195>/Constant' |
| 6070 | * Constant: '<S195>/Constant1' |
| 6071 | */ |
| 6072 | fusionAlg_B.radarObj.radar_20_obj.reserved.reserved1 = |
| 6073 | fusionAlg_P_g.Constant_Value_gri; |
| 6074 | fusionAlg_B.radarObj.radar_20_obj.reserved.reserved0 = |
| 6075 | fusionAlg_P_g.Constant1_Value_ji; |
| 6076 | |
| 6077 | /* BusCreator: '<S195>/Bus Creator1' */ |
| 6078 | fusionAlg_B.radarObj.radar_20_obj.objObstacleProb = |
| 6079 | *rtu_Radar410_Info_st_x63_33_O_m; |
| 6080 | fusionAlg_B.radarObj.radar_20_obj.objXPos_Stdev = |
| 6081 | *rtu_Radar410_Info_st_x63_33_O_d; |
| 6082 | fusionAlg_B.radarObj.radar_20_obj.objYPos_Stdev = |
| 6083 | *rtu_Radar410_Info_st_x63_33_O_e; |
| 6084 | fusionAlg_B.radarObj.radar_20_obj.objXVelRel_Stdev = |
| 6085 | *rtu_Radar410_Info_st_x63_33_O_b; |
| 6086 | fusionAlg_B.radarObj.radar_20_obj.objXAccRel = |
| 6087 | *rtu_Radar410_Info_st_x63_33_O_k; |
| 6088 | fusionAlg_B.radarObj.radar_20_obj.objExstProb = |
| 6089 | *rtu_Radar410_Info_st_x63_33_Obj; |
| 6090 | fusionAlg_B.radarObj.radar_20_obj.objYVelRel = |
| 6091 | *rtu_Radar410_Info_st_x63_33__hk; |
| 6092 | fusionAlg_B.radarObj.radar_20_obj.objXVelRel = |
| 6093 | *rtu_Radar410_Info_st_x63_33__nh; |
| 6094 | fusionAlg_B.radarObj.radar_20_obj.objXPos = *rtu_Radar410_Info_st_x63_33__kw; |
| 6095 | fusionAlg_B.radarObj.radar_20_obj.objYPos = *rtu_Radar410_Info_st_x63_33_O_n; |
| 6096 | |
| 6097 | /* DataTypeConversion: '<S196>/Data Type Conversion' */ |
| 6098 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x64_34_O_l); |
| 6099 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6100 | tmp = 0.0F; |
| 6101 | } else { |
| 6102 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 6103 | } |
| 6104 | |
| 6105 | fusionAlg_B.radarObj.radar_21_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 6106 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6107 | |
| 6108 | /* End of DataTypeConversion: '<S196>/Data Type Conversion' */ |
| 6109 | |
| 6110 | /* DataTypeConversion: '<S196>/Data Type Conversion1' */ |
| 6111 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x64_34_O_a); |
| 6112 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6113 | tmp = 0.0F; |
| 6114 | } else { |
| 6115 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6116 | } |
| 6117 | |
| 6118 | fusionAlg_B.radarObj.radar_21_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6119 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6120 | |
| 6121 | /* End of DataTypeConversion: '<S196>/Data Type Conversion1' */ |
| 6122 | |
| 6123 | /* DataTypeConversion: '<S196>/Data Type Conversion2' */ |
| 6124 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x64_34__gw); |
| 6125 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6126 | tmp = 0.0F; |
| 6127 | } else { |
| 6128 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6129 | } |
| 6130 | |
| 6131 | fusionAlg_B.radarObj.radar_21_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6132 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6133 | |
| 6134 | /* End of DataTypeConversion: '<S196>/Data Type Conversion2' */ |
| 6135 | |
| 6136 | /* DataTypeConversion: '<S196>/Data Type Conversion3' */ |
| 6137 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x64_34__gh); |
| 6138 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6139 | tmp = 0.0F; |
| 6140 | } else { |
| 6141 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6142 | } |
| 6143 | |
| 6144 | fusionAlg_B.radarObj.radar_21_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 6145 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6146 | |
| 6147 | /* End of DataTypeConversion: '<S196>/Data Type Conversion3' */ |
| 6148 | |
| 6149 | /* DataTypeConversion: '<S196>/Data Type Conversion4' */ |
| 6150 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x64_34__av); |
| 6151 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6152 | tmp = 0.0F; |
| 6153 | } else { |
| 6154 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6155 | } |
| 6156 | |
| 6157 | fusionAlg_B.radarObj.radar_21_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 6158 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6159 | |
| 6160 | /* End of DataTypeConversion: '<S196>/Data Type Conversion4' */ |
| 6161 | |
| 6162 | /* DataTypeConversion: '<S196>/Data Type Conversion5' */ |
| 6163 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x64_34_O_c); |
| 6164 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6165 | tmp = 0.0F; |
| 6166 | } else { |
| 6167 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6168 | } |
| 6169 | |
| 6170 | fusionAlg_B.radarObj.radar_21_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 6171 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6172 | |
| 6173 | /* End of DataTypeConversion: '<S196>/Data Type Conversion5' */ |
| 6174 | |
| 6175 | /* BusCreator: '<S196>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 6176 | * Constant: '<S196>/Constant' |
| 6177 | * Constant: '<S196>/Constant1' |
| 6178 | */ |
| 6179 | fusionAlg_B.radarObj.radar_21_obj.reserved.reserved1 = |
| 6180 | fusionAlg_P_g.Constant_Value_py; |
| 6181 | fusionAlg_B.radarObj.radar_21_obj.reserved.reserved0 = |
| 6182 | fusionAlg_P_g.Constant1_Value_lo; |
| 6183 | |
| 6184 | /* BusCreator: '<S196>/Bus Creator1' */ |
| 6185 | fusionAlg_B.radarObj.radar_21_obj.objObstacleProb = |
| 6186 | *rtu_Radar410_Info_st_x64_34_O_o; |
| 6187 | fusionAlg_B.radarObj.radar_21_obj.objXPos_Stdev = |
| 6188 | *rtu_Radar410_Info_st_x64_34__go; |
| 6189 | fusionAlg_B.radarObj.radar_21_obj.objYPos_Stdev = |
| 6190 | *rtu_Radar410_Info_st_x64_34_O_p; |
| 6191 | fusionAlg_B.radarObj.radar_21_obj.objXVelRel_Stdev = |
| 6192 | *rtu_Radar410_Info_st_x64_34_O_n; |
| 6193 | fusionAlg_B.radarObj.radar_21_obj.objXAccRel = |
| 6194 | *rtu_Radar410_Info_st_x64_34_O_g; |
| 6195 | fusionAlg_B.radarObj.radar_21_obj.objExstProb = |
| 6196 | *rtu_Radar410_Info_st_x64_34_Obj; |
| 6197 | fusionAlg_B.radarObj.radar_21_obj.objYVelRel = |
| 6198 | *rtu_Radar410_Info_st_x64_34__nz; |
| 6199 | fusionAlg_B.radarObj.radar_21_obj.objXVelRel = |
| 6200 | *rtu_Radar410_Info_st_x64_34_O_d; |
| 6201 | fusionAlg_B.radarObj.radar_21_obj.objXPos = *rtu_Radar410_Info_st_x64_34_O_b; |
| 6202 | fusionAlg_B.radarObj.radar_21_obj.objYPos = *rtu_Radar410_Info_st_x64_34_O_e; |
| 6203 | |
| 6204 | /* DataTypeConversion: '<S197>/Data Type Conversion' */ |
| 6205 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x65_35_O_h); |
| 6206 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6207 | tmp = 0.0F; |
| 6208 | } else { |
| 6209 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 6210 | } |
| 6211 | |
| 6212 | fusionAlg_B.radarObj.radar_22_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 6213 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6214 | |
| 6215 | /* End of DataTypeConversion: '<S197>/Data Type Conversion' */ |
| 6216 | |
| 6217 | /* DataTypeConversion: '<S197>/Data Type Conversion1' */ |
| 6218 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x65_35_O_b); |
| 6219 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6220 | tmp = 0.0F; |
| 6221 | } else { |
| 6222 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6223 | } |
| 6224 | |
| 6225 | fusionAlg_B.radarObj.radar_22_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6226 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6227 | |
| 6228 | /* End of DataTypeConversion: '<S197>/Data Type Conversion1' */ |
| 6229 | |
| 6230 | /* DataTypeConversion: '<S197>/Data Type Conversion2' */ |
| 6231 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x65_35_O_n); |
| 6232 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6233 | tmp = 0.0F; |
| 6234 | } else { |
| 6235 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6236 | } |
| 6237 | |
| 6238 | fusionAlg_B.radarObj.radar_22_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6239 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6240 | |
| 6241 | /* End of DataTypeConversion: '<S197>/Data Type Conversion2' */ |
| 6242 | |
| 6243 | /* DataTypeConversion: '<S197>/Data Type Conversion3' */ |
| 6244 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x65_35_O_f); |
| 6245 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6246 | tmp = 0.0F; |
| 6247 | } else { |
| 6248 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6249 | } |
| 6250 | |
| 6251 | fusionAlg_B.radarObj.radar_22_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 6252 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6253 | |
| 6254 | /* End of DataTypeConversion: '<S197>/Data Type Conversion3' */ |
| 6255 | |
| 6256 | /* DataTypeConversion: '<S197>/Data Type Conversion4' */ |
| 6257 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x65_35__dj); |
| 6258 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6259 | tmp = 0.0F; |
| 6260 | } else { |
| 6261 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6262 | } |
| 6263 | |
| 6264 | fusionAlg_B.radarObj.radar_22_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 6265 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6266 | |
| 6267 | /* End of DataTypeConversion: '<S197>/Data Type Conversion4' */ |
| 6268 | |
| 6269 | /* DataTypeConversion: '<S197>/Data Type Conversion5' */ |
| 6270 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x65_35__if); |
| 6271 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6272 | tmp = 0.0F; |
| 6273 | } else { |
| 6274 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6275 | } |
| 6276 | |
| 6277 | fusionAlg_B.radarObj.radar_22_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 6278 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6279 | |
| 6280 | /* End of DataTypeConversion: '<S197>/Data Type Conversion5' */ |
| 6281 | |
| 6282 | /* BusCreator: '<S197>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 6283 | * Constant: '<S197>/Constant' |
| 6284 | * Constant: '<S197>/Constant1' |
| 6285 | */ |
| 6286 | fusionAlg_B.radarObj.radar_22_obj.reserved.reserved1 = |
| 6287 | fusionAlg_P_g.Constant_Value_g0; |
| 6288 | fusionAlg_B.radarObj.radar_22_obj.reserved.reserved0 = |
| 6289 | fusionAlg_P_g.Constant1_Value_fv; |
| 6290 | |
| 6291 | /* BusCreator: '<S197>/Bus Creator1' */ |
| 6292 | fusionAlg_B.radarObj.radar_22_obj.objObstacleProb = |
| 6293 | *rtu_Radar410_Info_st_x65_35_O_m; |
| 6294 | fusionAlg_B.radarObj.radar_22_obj.objXPos_Stdev = |
| 6295 | *rtu_Radar410_Info_st_x65_35__i3; |
| 6296 | fusionAlg_B.radarObj.radar_22_obj.objYPos_Stdev = |
| 6297 | *rtu_Radar410_Info_st_x65_35_O_i; |
| 6298 | fusionAlg_B.radarObj.radar_22_obj.objXVelRel_Stdev = |
| 6299 | *rtu_Radar410_Info_st_x65_35_O_k; |
| 6300 | fusionAlg_B.radarObj.radar_22_obj.objXAccRel = |
| 6301 | *rtu_Radar410_Info_st_x65_35__ku; |
| 6302 | fusionAlg_B.radarObj.radar_22_obj.objExstProb = |
| 6303 | *rtu_Radar410_Info_st_x65_35_Obj; |
| 6304 | fusionAlg_B.radarObj.radar_22_obj.objYVelRel = |
| 6305 | *rtu_Radar410_Info_st_x65_35_O_d; |
| 6306 | fusionAlg_B.radarObj.radar_22_obj.objXVelRel = |
| 6307 | *rtu_Radar410_Info_st_x65_35__fy; |
| 6308 | fusionAlg_B.radarObj.radar_22_obj.objXPos = *rtu_Radar410_Info_st_x65_35_O_o; |
| 6309 | fusionAlg_B.radarObj.radar_22_obj.objYPos = *rtu_Radar410_Info_st_x65_35__n5; |
| 6310 | |
| 6311 | /* DataTypeConversion: '<S187>/Data Type Conversion' */ |
| 6312 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x66_36_O_h); |
| 6313 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6314 | tmp = 0.0F; |
| 6315 | } else { |
| 6316 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 6317 | } |
| 6318 | |
| 6319 | fusionAlg_B.radarObj.radar_23_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 6320 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6321 | |
| 6322 | /* End of DataTypeConversion: '<S187>/Data Type Conversion' */ |
| 6323 | |
| 6324 | /* DataTypeConversion: '<S187>/Data Type Conversion1' */ |
| 6325 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x66_36_O_m); |
| 6326 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6327 | tmp = 0.0F; |
| 6328 | } else { |
| 6329 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6330 | } |
| 6331 | |
| 6332 | fusionAlg_B.radarObj.radar_23_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6333 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6334 | |
| 6335 | /* End of DataTypeConversion: '<S187>/Data Type Conversion1' */ |
| 6336 | |
| 6337 | /* DataTypeConversion: '<S187>/Data Type Conversion2' */ |
| 6338 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x66_36_O_a); |
| 6339 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6340 | tmp = 0.0F; |
| 6341 | } else { |
| 6342 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6343 | } |
| 6344 | |
| 6345 | fusionAlg_B.radarObj.radar_23_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6346 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6347 | |
| 6348 | /* End of DataTypeConversion: '<S187>/Data Type Conversion2' */ |
| 6349 | |
| 6350 | /* DataTypeConversion: '<S187>/Data Type Conversion3' */ |
| 6351 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x66_36_O_j); |
| 6352 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6353 | tmp = 0.0F; |
| 6354 | } else { |
| 6355 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6356 | } |
| 6357 | |
| 6358 | fusionAlg_B.radarObj.radar_23_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 6359 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6360 | |
| 6361 | /* End of DataTypeConversion: '<S187>/Data Type Conversion3' */ |
| 6362 | |
| 6363 | /* DataTypeConversion: '<S187>/Data Type Conversion4' */ |
| 6364 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x66_36_O_d); |
| 6365 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6366 | tmp = 0.0F; |
| 6367 | } else { |
| 6368 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6369 | } |
| 6370 | |
| 6371 | fusionAlg_B.radarObj.radar_23_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 6372 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6373 | |
| 6374 | /* End of DataTypeConversion: '<S187>/Data Type Conversion4' */ |
| 6375 | |
| 6376 | /* DataTypeConversion: '<S187>/Data Type Conversion5' */ |
| 6377 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x66_36_O_f); |
| 6378 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6379 | tmp = 0.0F; |
| 6380 | } else { |
| 6381 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6382 | } |
| 6383 | |
| 6384 | fusionAlg_B.radarObj.radar_23_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 6385 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6386 | |
| 6387 | /* End of DataTypeConversion: '<S187>/Data Type Conversion5' */ |
| 6388 | |
| 6389 | /* BusCreator: '<S187>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 6390 | * Constant: '<S187>/Constant' |
| 6391 | * Constant: '<S187>/Constant1' |
| 6392 | */ |
| 6393 | fusionAlg_B.radarObj.radar_23_obj.reserved.reserved1 = |
| 6394 | fusionAlg_P_g.Constant_Value_od; |
| 6395 | fusionAlg_B.radarObj.radar_23_obj.reserved.reserved0 = |
| 6396 | fusionAlg_P_g.Constant1_Value_px; |
| 6397 | |
| 6398 | /* BusCreator: '<S187>/Bus Creator1' */ |
| 6399 | fusionAlg_B.radarObj.radar_23_obj.objObstacleProb = |
| 6400 | *rtu_Radar410_Info_st_x66_36_O_n; |
| 6401 | fusionAlg_B.radarObj.radar_23_obj.objXPos_Stdev = |
| 6402 | *rtu_Radar410_Info_st_x66_36_O_l; |
| 6403 | fusionAlg_B.radarObj.radar_23_obj.objYPos_Stdev = |
| 6404 | *rtu_Radar410_Info_st_x66_36_O_e; |
| 6405 | fusionAlg_B.radarObj.radar_23_obj.objXVelRel_Stdev = |
| 6406 | *rtu_Radar410_Info_st_x66_36_O_i; |
| 6407 | fusionAlg_B.radarObj.radar_23_obj.objXAccRel = |
| 6408 | *rtu_Radar410_Info_st_x66_36_O_c; |
| 6409 | fusionAlg_B.radarObj.radar_23_obj.objExstProb = |
| 6410 | *rtu_Radar410_Info_st_x66_36_Obj; |
| 6411 | fusionAlg_B.radarObj.radar_23_obj.objYVelRel = |
| 6412 | *rtu_Radar410_Info_st_x66_36_O_g; |
| 6413 | fusionAlg_B.radarObj.radar_23_obj.objXVelRel = |
| 6414 | *rtu_Radar410_Info_st_x66_36__aj; |
| 6415 | fusionAlg_B.radarObj.radar_23_obj.objXPos = *rtu_Radar410_Info_st_x66_36__iz; |
| 6416 | fusionAlg_B.radarObj.radar_23_obj.objYPos = *rtu_Radar410_Info_st_x66_36__f4; |
| 6417 | |
| 6418 | /* DataTypeConversion: '<S188>/Data Type Conversion' */ |
| 6419 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x67_37_O_l); |
| 6420 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6421 | tmp = 0.0F; |
| 6422 | } else { |
| 6423 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 6424 | } |
| 6425 | |
| 6426 | fusionAlg_B.radarObj.radar_24_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 6427 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6428 | |
| 6429 | /* End of DataTypeConversion: '<S188>/Data Type Conversion' */ |
| 6430 | |
| 6431 | /* DataTypeConversion: '<S188>/Data Type Conversion1' */ |
| 6432 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x67_37_O_h); |
| 6433 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6434 | tmp = 0.0F; |
| 6435 | } else { |
| 6436 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6437 | } |
| 6438 | |
| 6439 | fusionAlg_B.radarObj.radar_24_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6440 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6441 | |
| 6442 | /* End of DataTypeConversion: '<S188>/Data Type Conversion1' */ |
| 6443 | |
| 6444 | /* DataTypeConversion: '<S188>/Data Type Conversion2' */ |
| 6445 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x67_37_O_e); |
| 6446 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6447 | tmp = 0.0F; |
| 6448 | } else { |
| 6449 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6450 | } |
| 6451 | |
| 6452 | fusionAlg_B.radarObj.radar_24_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6453 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6454 | |
| 6455 | /* End of DataTypeConversion: '<S188>/Data Type Conversion2' */ |
| 6456 | |
| 6457 | /* DataTypeConversion: '<S188>/Data Type Conversion3' */ |
| 6458 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x67_37_O_a); |
| 6459 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6460 | tmp = 0.0F; |
| 6461 | } else { |
| 6462 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6463 | } |
| 6464 | |
| 6465 | fusionAlg_B.radarObj.radar_24_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 6466 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6467 | |
| 6468 | /* End of DataTypeConversion: '<S188>/Data Type Conversion3' */ |
| 6469 | |
| 6470 | /* DataTypeConversion: '<S188>/Data Type Conversion4' */ |
| 6471 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x67_37__er); |
| 6472 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6473 | tmp = 0.0F; |
| 6474 | } else { |
| 6475 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6476 | } |
| 6477 | |
| 6478 | fusionAlg_B.radarObj.radar_24_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 6479 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6480 | |
| 6481 | /* End of DataTypeConversion: '<S188>/Data Type Conversion4' */ |
| 6482 | |
| 6483 | /* DataTypeConversion: '<S188>/Data Type Conversion5' */ |
| 6484 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x67_37_O_n); |
| 6485 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6486 | tmp = 0.0F; |
| 6487 | } else { |
| 6488 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6489 | } |
| 6490 | |
| 6491 | fusionAlg_B.radarObj.radar_24_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 6492 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6493 | |
| 6494 | /* End of DataTypeConversion: '<S188>/Data Type Conversion5' */ |
| 6495 | |
| 6496 | /* BusCreator: '<S188>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 6497 | * Constant: '<S188>/Constant' |
| 6498 | * Constant: '<S188>/Constant1' |
| 6499 | */ |
| 6500 | fusionAlg_B.radarObj.radar_24_obj.reserved.reserved1 = |
| 6501 | fusionAlg_P_g.Constant_Value_kc; |
| 6502 | fusionAlg_B.radarObj.radar_24_obj.reserved.reserved0 = |
| 6503 | fusionAlg_P_g.Constant1_Value_bf; |
| 6504 | |
| 6505 | /* BusCreator: '<S188>/Bus Creator1' */ |
| 6506 | fusionAlg_B.radarObj.radar_24_obj.objObstacleProb = |
| 6507 | *rtu_Radar410_Info_st_x67_37_O_p; |
| 6508 | fusionAlg_B.radarObj.radar_24_obj.objXPos_Stdev = |
| 6509 | *rtu_Radar410_Info_st_x67_37_O_m; |
| 6510 | fusionAlg_B.radarObj.radar_24_obj.objYPos_Stdev = |
| 6511 | *rtu_Radar410_Info_st_x67_37__gs; |
| 6512 | fusionAlg_B.radarObj.radar_24_obj.objXVelRel_Stdev = |
| 6513 | *rtu_Radar410_Info_st_x67_37_O_g; |
| 6514 | fusionAlg_B.radarObj.radar_24_obj.objXAccRel = |
| 6515 | *rtu_Radar410_Info_st_x67_37_O_o; |
| 6516 | fusionAlg_B.radarObj.radar_24_obj.objExstProb = |
| 6517 | *rtu_Radar410_Info_st_x67_37_Obj; |
| 6518 | fusionAlg_B.radarObj.radar_24_obj.objYVelRel = |
| 6519 | *rtu_Radar410_Info_st_x67_37__mq; |
| 6520 | fusionAlg_B.radarObj.radar_24_obj.objXVelRel = |
| 6521 | *rtu_Radar410_Info_st_x67_37__ex; |
| 6522 | fusionAlg_B.radarObj.radar_24_obj.objXPos = *rtu_Radar410_Info_st_x67_37_O_j; |
| 6523 | fusionAlg_B.radarObj.radar_24_obj.objYPos = *rtu_Radar410_Info_st_x67_37_O_c; |
| 6524 | |
| 6525 | /* DataTypeConversion: '<S198>/Data Type Conversion' */ |
| 6526 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x68_38_O_j); |
| 6527 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6528 | tmp = 0.0F; |
| 6529 | } else { |
| 6530 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 6531 | } |
| 6532 | |
| 6533 | fusionAlg_B.radarObj.radar_25_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 6534 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6535 | |
| 6536 | /* End of DataTypeConversion: '<S198>/Data Type Conversion' */ |
| 6537 | |
| 6538 | /* DataTypeConversion: '<S198>/Data Type Conversion1' */ |
| 6539 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x68_38__cz); |
| 6540 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6541 | tmp = 0.0F; |
| 6542 | } else { |
| 6543 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6544 | } |
| 6545 | |
| 6546 | fusionAlg_B.radarObj.radar_25_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6547 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6548 | |
| 6549 | /* End of DataTypeConversion: '<S198>/Data Type Conversion1' */ |
| 6550 | |
| 6551 | /* DataTypeConversion: '<S198>/Data Type Conversion2' */ |
| 6552 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x68_38_O_e); |
| 6553 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6554 | tmp = 0.0F; |
| 6555 | } else { |
| 6556 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6557 | } |
| 6558 | |
| 6559 | fusionAlg_B.radarObj.radar_25_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6560 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6561 | |
| 6562 | /* End of DataTypeConversion: '<S198>/Data Type Conversion2' */ |
| 6563 | |
| 6564 | /* DataTypeConversion: '<S198>/Data Type Conversion3' */ |
| 6565 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x68_38_O_p); |
| 6566 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6567 | tmp = 0.0F; |
| 6568 | } else { |
| 6569 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6570 | } |
| 6571 | |
| 6572 | fusionAlg_B.radarObj.radar_25_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 6573 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6574 | |
| 6575 | /* End of DataTypeConversion: '<S198>/Data Type Conversion3' */ |
| 6576 | |
| 6577 | /* DataTypeConversion: '<S198>/Data Type Conversion4' */ |
| 6578 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x68_38__po); |
| 6579 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6580 | tmp = 0.0F; |
| 6581 | } else { |
| 6582 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6583 | } |
| 6584 | |
| 6585 | fusionAlg_B.radarObj.radar_25_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 6586 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6587 | |
| 6588 | /* End of DataTypeConversion: '<S198>/Data Type Conversion4' */ |
| 6589 | |
| 6590 | /* DataTypeConversion: '<S198>/Data Type Conversion5' */ |
| 6591 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x68_38_O_o); |
| 6592 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6593 | tmp = 0.0F; |
| 6594 | } else { |
| 6595 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6596 | } |
| 6597 | |
| 6598 | fusionAlg_B.radarObj.radar_25_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 6599 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6600 | |
| 6601 | /* End of DataTypeConversion: '<S198>/Data Type Conversion5' */ |
| 6602 | |
| 6603 | /* BusCreator: '<S198>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 6604 | * Constant: '<S198>/Constant' |
| 6605 | * Constant: '<S198>/Constant1' |
| 6606 | */ |
| 6607 | fusionAlg_B.radarObj.radar_25_obj.reserved.reserved1 = |
| 6608 | fusionAlg_P_g.Constant_Value_j45; |
| 6609 | fusionAlg_B.radarObj.radar_25_obj.reserved.reserved0 = |
| 6610 | fusionAlg_P_g.Constant1_Value_fn; |
| 6611 | |
| 6612 | /* BusCreator: '<S198>/Bus Creator1' */ |
| 6613 | fusionAlg_B.radarObj.radar_25_obj.objObstacleProb = |
| 6614 | *rtu_Radar410_Info_st_x68_38__av; |
| 6615 | fusionAlg_B.radarObj.radar_25_obj.objXPos_Stdev = |
| 6616 | *rtu_Radar410_Info_st_x68_38_O_c; |
| 6617 | fusionAlg_B.radarObj.radar_25_obj.objYPos_Stdev = |
| 6618 | *rtu_Radar410_Info_st_x68_38_O_n; |
| 6619 | fusionAlg_B.radarObj.radar_25_obj.objXVelRel_Stdev = |
| 6620 | *rtu_Radar410_Info_st_x68_38_O_a; |
| 6621 | fusionAlg_B.radarObj.radar_25_obj.objXAccRel = |
| 6622 | *rtu_Radar410_Info_st_x68_38_O_l; |
| 6623 | fusionAlg_B.radarObj.radar_25_obj.objExstProb = |
| 6624 | *rtu_Radar410_Info_st_x68_38_Obj; |
| 6625 | fusionAlg_B.radarObj.radar_25_obj.objYVelRel = |
| 6626 | *rtu_Radar410_Info_st_x68_38_O_k; |
| 6627 | fusionAlg_B.radarObj.radar_25_obj.objXVelRel = |
| 6628 | *rtu_Radar410_Info_st_x68_38__or; |
| 6629 | fusionAlg_B.radarObj.radar_25_obj.objXPos = *rtu_Radar410_Info_st_x68_38__ay; |
| 6630 | fusionAlg_B.radarObj.radar_25_obj.objYPos = *rtu_Radar410_Info_st_x68_38__pq; |
| 6631 | |
| 6632 | /* DataTypeConversion: '<S199>/Data Type Conversion' */ |
| 6633 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x69_39_O_h); |
| 6634 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6635 | tmp = 0.0F; |
| 6636 | } else { |
| 6637 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 6638 | } |
| 6639 | |
| 6640 | fusionAlg_B.radarObj.radar_26_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 6641 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6642 | |
| 6643 | /* End of DataTypeConversion: '<S199>/Data Type Conversion' */ |
| 6644 | |
| 6645 | /* DataTypeConversion: '<S199>/Data Type Conversion1' */ |
| 6646 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x69_39_O_e); |
| 6647 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6648 | tmp = 0.0F; |
| 6649 | } else { |
| 6650 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6651 | } |
| 6652 | |
| 6653 | fusionAlg_B.radarObj.radar_26_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6654 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6655 | |
| 6656 | /* End of DataTypeConversion: '<S199>/Data Type Conversion1' */ |
| 6657 | |
| 6658 | /* DataTypeConversion: '<S199>/Data Type Conversion2' */ |
| 6659 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x69_39__js); |
| 6660 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6661 | tmp = 0.0F; |
| 6662 | } else { |
| 6663 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6664 | } |
| 6665 | |
| 6666 | fusionAlg_B.radarObj.radar_26_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6667 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6668 | |
| 6669 | /* End of DataTypeConversion: '<S199>/Data Type Conversion2' */ |
| 6670 | |
| 6671 | /* DataTypeConversion: '<S199>/Data Type Conversion3' */ |
| 6672 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x69_39__dx); |
| 6673 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6674 | tmp = 0.0F; |
| 6675 | } else { |
| 6676 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6677 | } |
| 6678 | |
| 6679 | fusionAlg_B.radarObj.radar_26_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 6680 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6681 | |
| 6682 | /* End of DataTypeConversion: '<S199>/Data Type Conversion3' */ |
| 6683 | |
| 6684 | /* DataTypeConversion: '<S199>/Data Type Conversion4' */ |
| 6685 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x69_39__ji); |
| 6686 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6687 | tmp = 0.0F; |
| 6688 | } else { |
| 6689 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6690 | } |
| 6691 | |
| 6692 | fusionAlg_B.radarObj.radar_26_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 6693 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6694 | |
| 6695 | /* End of DataTypeConversion: '<S199>/Data Type Conversion4' */ |
| 6696 | |
| 6697 | /* DataTypeConversion: '<S199>/Data Type Conversion5' */ |
| 6698 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x69_39_O_b); |
| 6699 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6700 | tmp = 0.0F; |
| 6701 | } else { |
| 6702 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6703 | } |
| 6704 | |
| 6705 | fusionAlg_B.radarObj.radar_26_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 6706 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6707 | |
| 6708 | /* End of DataTypeConversion: '<S199>/Data Type Conversion5' */ |
| 6709 | |
| 6710 | /* BusCreator: '<S199>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 6711 | * Constant: '<S199>/Constant' |
| 6712 | * Constant: '<S199>/Constant1' |
| 6713 | */ |
| 6714 | fusionAlg_B.radarObj.radar_26_obj.reserved.reserved1 = |
| 6715 | fusionAlg_P_g.Constant_Value_az; |
| 6716 | fusionAlg_B.radarObj.radar_26_obj.reserved.reserved0 = |
| 6717 | fusionAlg_P_g.Constant1_Value_o3; |
| 6718 | |
| 6719 | /* BusCreator: '<S199>/Bus Creator1' */ |
| 6720 | fusionAlg_B.radarObj.radar_26_obj.objObstacleProb = |
| 6721 | *rtu_Radar410_Info_st_x69_39_O_d; |
| 6722 | fusionAlg_B.radarObj.radar_26_obj.objXPos_Stdev = |
| 6723 | *rtu_Radar410_Info_st_x69_39_O_a; |
| 6724 | fusionAlg_B.radarObj.radar_26_obj.objYPos_Stdev = |
| 6725 | *rtu_Radar410_Info_st_x69_39_O_p; |
| 6726 | fusionAlg_B.radarObj.radar_26_obj.objXVelRel_Stdev = |
| 6727 | *rtu_Radar410_Info_st_x69_39_O_j; |
| 6728 | fusionAlg_B.radarObj.radar_26_obj.objXAccRel = |
| 6729 | *rtu_Radar410_Info_st_x69_39_O_c; |
| 6730 | fusionAlg_B.radarObj.radar_26_obj.objExstProb = |
| 6731 | *rtu_Radar410_Info_st_x69_39_Obj; |
| 6732 | fusionAlg_B.radarObj.radar_26_obj.objYVelRel = |
| 6733 | *rtu_Radar410_Info_st_x69_39_O_l; |
| 6734 | fusionAlg_B.radarObj.radar_26_obj.objXVelRel = |
| 6735 | *rtu_Radar410_Info_st_x69_39__og; |
| 6736 | fusionAlg_B.radarObj.radar_26_obj.objXPos = *rtu_Radar410_Info_st_x69_39_O_k; |
| 6737 | fusionAlg_B.radarObj.radar_26_obj.objYPos = *rtu_Radar410_Info_st_x69_39_O_o; |
| 6738 | |
| 6739 | /* DataTypeConversion: '<S207>/Data Type Conversion' */ |
| 6740 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6A_3A_O_k); |
| 6741 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6742 | tmp = 0.0F; |
| 6743 | } else { |
| 6744 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 6745 | } |
| 6746 | |
| 6747 | fusionAlg_B.radarObj.radar_27_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 6748 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6749 | |
| 6750 | /* End of DataTypeConversion: '<S207>/Data Type Conversion' */ |
| 6751 | |
| 6752 | /* DataTypeConversion: '<S207>/Data Type Conversion1' */ |
| 6753 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6A_3A_O_i); |
| 6754 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6755 | tmp = 0.0F; |
| 6756 | } else { |
| 6757 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6758 | } |
| 6759 | |
| 6760 | fusionAlg_B.radarObj.radar_27_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6761 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6762 | |
| 6763 | /* End of DataTypeConversion: '<S207>/Data Type Conversion1' */ |
| 6764 | |
| 6765 | /* DataTypeConversion: '<S207>/Data Type Conversion2' */ |
| 6766 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6A_3A__ad); |
| 6767 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6768 | tmp = 0.0F; |
| 6769 | } else { |
| 6770 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6771 | } |
| 6772 | |
| 6773 | fusionAlg_B.radarObj.radar_27_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6774 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6775 | |
| 6776 | /* End of DataTypeConversion: '<S207>/Data Type Conversion2' */ |
| 6777 | |
| 6778 | /* DataTypeConversion: '<S207>/Data Type Conversion3' */ |
| 6779 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6A_3A_O_e); |
| 6780 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6781 | tmp = 0.0F; |
| 6782 | } else { |
| 6783 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6784 | } |
| 6785 | |
| 6786 | fusionAlg_B.radarObj.radar_27_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 6787 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6788 | |
| 6789 | /* End of DataTypeConversion: '<S207>/Data Type Conversion3' */ |
| 6790 | |
| 6791 | /* DataTypeConversion: '<S207>/Data Type Conversion4' */ |
| 6792 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6A_3A__du); |
| 6793 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6794 | tmp = 0.0F; |
| 6795 | } else { |
| 6796 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6797 | } |
| 6798 | |
| 6799 | fusionAlg_B.radarObj.radar_27_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 6800 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6801 | |
| 6802 | /* End of DataTypeConversion: '<S207>/Data Type Conversion4' */ |
| 6803 | |
| 6804 | /* DataTypeConversion: '<S207>/Data Type Conversion5' */ |
| 6805 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6A_3A_O_b); |
| 6806 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6807 | tmp = 0.0F; |
| 6808 | } else { |
| 6809 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6810 | } |
| 6811 | |
| 6812 | fusionAlg_B.radarObj.radar_27_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 6813 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6814 | |
| 6815 | /* End of DataTypeConversion: '<S207>/Data Type Conversion5' */ |
| 6816 | |
| 6817 | /* BusCreator: '<S207>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 6818 | * Constant: '<S207>/Constant' |
| 6819 | * Constant: '<S207>/Constant1' |
| 6820 | */ |
| 6821 | fusionAlg_B.radarObj.radar_27_obj.reserved.reserved1 = |
| 6822 | fusionAlg_P_g.Constant_Value_cgk; |
| 6823 | fusionAlg_B.radarObj.radar_27_obj.reserved.reserved0 = |
| 6824 | fusionAlg_P_g.Constant1_Value_jnm; |
| 6825 | |
| 6826 | /* BusCreator: '<S207>/Bus Creator1' */ |
| 6827 | fusionAlg_B.radarObj.radar_27_obj.objObstacleProb = |
| 6828 | *rtu_Radar410_Info_st_x6A_3A_O_h; |
| 6829 | fusionAlg_B.radarObj.radar_27_obj.objXPos_Stdev = |
| 6830 | *rtu_Radar410_Info_st_x6A_3A__e4; |
| 6831 | fusionAlg_B.radarObj.radar_27_obj.objYPos_Stdev = |
| 6832 | *rtu_Radar410_Info_st_x6A_3A_O_a; |
| 6833 | fusionAlg_B.radarObj.radar_27_obj.objXVelRel_Stdev = |
| 6834 | *rtu_Radar410_Info_st_x6A_3A_O_j; |
| 6835 | fusionAlg_B.radarObj.radar_27_obj.objXAccRel = |
| 6836 | *rtu_Radar410_Info_st_x6A_3A_O_o; |
| 6837 | fusionAlg_B.radarObj.radar_27_obj.objExstProb = |
| 6838 | *rtu_Radar410_Info_st_x6A_3A_Obj; |
| 6839 | fusionAlg_B.radarObj.radar_27_obj.objYVelRel = |
| 6840 | *rtu_Radar410_Info_st_x6A_3A_O_d; |
| 6841 | fusionAlg_B.radarObj.radar_27_obj.objXVelRel = |
| 6842 | *rtu_Radar410_Info_st_x6A_3A__i5; |
| 6843 | fusionAlg_B.radarObj.radar_27_obj.objXPos = *rtu_Radar410_Info_st_x6A_3A_O_n; |
| 6844 | fusionAlg_B.radarObj.radar_27_obj.objYPos = *rtu_Radar410_Info_st_x6A_3A_O_l; |
| 6845 | |
| 6846 | /* DataTypeConversion: '<S210>/Data Type Conversion' */ |
| 6847 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6B_3B__cu); |
| 6848 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6849 | tmp = 0.0F; |
| 6850 | } else { |
| 6851 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 6852 | } |
| 6853 | |
| 6854 | fusionAlg_B.radarObj.radar_28_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 6855 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6856 | |
| 6857 | /* End of DataTypeConversion: '<S210>/Data Type Conversion' */ |
| 6858 | |
| 6859 | /* DataTypeConversion: '<S210>/Data Type Conversion1' */ |
| 6860 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6B_3B__hk); |
| 6861 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6862 | tmp = 0.0F; |
| 6863 | } else { |
| 6864 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6865 | } |
| 6866 | |
| 6867 | fusionAlg_B.radarObj.radar_28_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6868 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6869 | |
| 6870 | /* End of DataTypeConversion: '<S210>/Data Type Conversion1' */ |
| 6871 | |
| 6872 | /* DataTypeConversion: '<S210>/Data Type Conversion2' */ |
| 6873 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6B_3B_O_h); |
| 6874 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6875 | tmp = 0.0F; |
| 6876 | } else { |
| 6877 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6878 | } |
| 6879 | |
| 6880 | fusionAlg_B.radarObj.radar_28_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6881 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6882 | |
| 6883 | /* End of DataTypeConversion: '<S210>/Data Type Conversion2' */ |
| 6884 | |
| 6885 | /* DataTypeConversion: '<S210>/Data Type Conversion3' */ |
| 6886 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6B_3B_O_p); |
| 6887 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6888 | tmp = 0.0F; |
| 6889 | } else { |
| 6890 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6891 | } |
| 6892 | |
| 6893 | fusionAlg_B.radarObj.radar_28_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 6894 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6895 | |
| 6896 | /* End of DataTypeConversion: '<S210>/Data Type Conversion3' */ |
| 6897 | |
| 6898 | /* DataTypeConversion: '<S210>/Data Type Conversion4' */ |
| 6899 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6B_3B_O_j); |
| 6900 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6901 | tmp = 0.0F; |
| 6902 | } else { |
| 6903 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6904 | } |
| 6905 | |
| 6906 | fusionAlg_B.radarObj.radar_28_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 6907 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6908 | |
| 6909 | /* End of DataTypeConversion: '<S210>/Data Type Conversion4' */ |
| 6910 | |
| 6911 | /* DataTypeConversion: '<S210>/Data Type Conversion5' */ |
| 6912 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6B_3B_O_d); |
| 6913 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6914 | tmp = 0.0F; |
| 6915 | } else { |
| 6916 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6917 | } |
| 6918 | |
| 6919 | fusionAlg_B.radarObj.radar_28_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 6920 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6921 | |
| 6922 | /* End of DataTypeConversion: '<S210>/Data Type Conversion5' */ |
| 6923 | |
| 6924 | /* BusCreator: '<S210>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 6925 | * Constant: '<S210>/Constant' |
| 6926 | * Constant: '<S210>/Constant1' |
| 6927 | */ |
| 6928 | fusionAlg_B.radarObj.radar_28_obj.reserved.reserved1 = |
| 6929 | fusionAlg_P_g.Constant_Value_n4; |
| 6930 | fusionAlg_B.radarObj.radar_28_obj.reserved.reserved0 = |
| 6931 | fusionAlg_P_g.Constant1_Value_cb; |
| 6932 | |
| 6933 | /* BusCreator: '<S210>/Bus Creator1' */ |
| 6934 | fusionAlg_B.radarObj.radar_28_obj.objObstacleProb = |
| 6935 | *rtu_Radar410_Info_st_x6B_3B_O_k; |
| 6936 | fusionAlg_B.radarObj.radar_28_obj.objXPos_Stdev = |
| 6937 | *rtu_Radar410_Info_st_x6B_3B__cy; |
| 6938 | fusionAlg_B.radarObj.radar_28_obj.objYPos_Stdev = |
| 6939 | *rtu_Radar410_Info_st_x6B_3B_O_c; |
| 6940 | fusionAlg_B.radarObj.radar_28_obj.objXVelRel_Stdev = |
| 6941 | *rtu_Radar410_Info_st_x6B_3B_O_o; |
| 6942 | fusionAlg_B.radarObj.radar_28_obj.objXAccRel = |
| 6943 | *rtu_Radar410_Info_st_x6B_3B_O_g; |
| 6944 | fusionAlg_B.radarObj.radar_28_obj.objExstProb = |
| 6945 | *rtu_Radar410_Info_st_x6B_3B_Obj; |
| 6946 | fusionAlg_B.radarObj.radar_28_obj.objYVelRel = |
| 6947 | *rtu_Radar410_Info_st_x6B_3B__g2; |
| 6948 | fusionAlg_B.radarObj.radar_28_obj.objXVelRel = |
| 6949 | *rtu_Radar410_Info_st_x6B_3B__j3; |
| 6950 | fusionAlg_B.radarObj.radar_28_obj.objXPos = *rtu_Radar410_Info_st_x6B_3B_O_e; |
| 6951 | fusionAlg_B.radarObj.radar_28_obj.objYPos = *rtu_Radar410_Info_st_x6B_3B__cf; |
| 6952 | |
| 6953 | /* DataTypeConversion: '<S211>/Data Type Conversion' */ |
| 6954 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6C_3C_O_c); |
| 6955 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6956 | tmp = 0.0F; |
| 6957 | } else { |
| 6958 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 6959 | } |
| 6960 | |
| 6961 | fusionAlg_B.radarObj.radar_29_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 6962 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 6963 | |
| 6964 | /* End of DataTypeConversion: '<S211>/Data Type Conversion' */ |
| 6965 | |
| 6966 | /* DataTypeConversion: '<S211>/Data Type Conversion1' */ |
| 6967 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6C_3C__oi); |
| 6968 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6969 | tmp = 0.0F; |
| 6970 | } else { |
| 6971 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6972 | } |
| 6973 | |
| 6974 | fusionAlg_B.radarObj.radar_29_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 6975 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6976 | |
| 6977 | /* End of DataTypeConversion: '<S211>/Data Type Conversion1' */ |
| 6978 | |
| 6979 | /* DataTypeConversion: '<S211>/Data Type Conversion2' */ |
| 6980 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6C_3C_O_o); |
| 6981 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6982 | tmp = 0.0F; |
| 6983 | } else { |
| 6984 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6985 | } |
| 6986 | |
| 6987 | fusionAlg_B.radarObj.radar_29_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 6988 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 6989 | |
| 6990 | /* End of DataTypeConversion: '<S211>/Data Type Conversion2' */ |
| 6991 | |
| 6992 | /* DataTypeConversion: '<S211>/Data Type Conversion3' */ |
| 6993 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6C_3C_O_b); |
| 6994 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 6995 | tmp = 0.0F; |
| 6996 | } else { |
| 6997 | tmp = (real32_T)fmod(tmp, 256.0); |
| 6998 | } |
| 6999 | |
| 7000 | fusionAlg_B.radarObj.radar_29_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7001 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7002 | |
| 7003 | /* End of DataTypeConversion: '<S211>/Data Type Conversion3' */ |
| 7004 | |
| 7005 | /* DataTypeConversion: '<S211>/Data Type Conversion4' */ |
| 7006 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6C_3C__ch); |
| 7007 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7008 | tmp = 0.0F; |
| 7009 | } else { |
| 7010 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7011 | } |
| 7012 | |
| 7013 | fusionAlg_B.radarObj.radar_29_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7014 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7015 | |
| 7016 | /* End of DataTypeConversion: '<S211>/Data Type Conversion4' */ |
| 7017 | |
| 7018 | /* DataTypeConversion: '<S211>/Data Type Conversion5' */ |
| 7019 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6C_3C_O_a); |
| 7020 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7021 | tmp = 0.0F; |
| 7022 | } else { |
| 7023 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7024 | } |
| 7025 | |
| 7026 | fusionAlg_B.radarObj.radar_29_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7027 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7028 | |
| 7029 | /* End of DataTypeConversion: '<S211>/Data Type Conversion5' */ |
| 7030 | |
| 7031 | /* BusCreator: '<S211>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7032 | * Constant: '<S211>/Constant' |
| 7033 | * Constant: '<S211>/Constant1' |
| 7034 | */ |
| 7035 | fusionAlg_B.radarObj.radar_29_obj.reserved.reserved1 = |
| 7036 | fusionAlg_P_g.Constant_Value_hi; |
| 7037 | fusionAlg_B.radarObj.radar_29_obj.reserved.reserved0 = |
| 7038 | fusionAlg_P_g.Constant1_Value_pl; |
| 7039 | |
| 7040 | /* BusCreator: '<S211>/Bus Creator1' */ |
| 7041 | fusionAlg_B.radarObj.radar_29_obj.objObstacleProb = |
| 7042 | *rtu_Radar410_Info_st_x6C_3C_O_d; |
| 7043 | fusionAlg_B.radarObj.radar_29_obj.objXPos_Stdev = |
| 7044 | *rtu_Radar410_Info_st_x6C_3C_O_k; |
| 7045 | fusionAlg_B.radarObj.radar_29_obj.objYPos_Stdev = |
| 7046 | *rtu_Radar410_Info_st_x6C_3C__bn; |
| 7047 | fusionAlg_B.radarObj.radar_29_obj.objXVelRel_Stdev = |
| 7048 | *rtu_Radar410_Info_st_x6C_3C_O_h; |
| 7049 | fusionAlg_B.radarObj.radar_29_obj.objXAccRel = |
| 7050 | *rtu_Radar410_Info_st_x6C_3C_O_l; |
| 7051 | fusionAlg_B.radarObj.radar_29_obj.objExstProb = |
| 7052 | *rtu_Radar410_Info_st_x6C_3C_Obj; |
| 7053 | fusionAlg_B.radarObj.radar_29_obj.objYVelRel = |
| 7054 | *rtu_Radar410_Info_st_x6C_3C__bm; |
| 7055 | fusionAlg_B.radarObj.radar_29_obj.objXVelRel = |
| 7056 | *rtu_Radar410_Info_st_x6C_3C__ak; |
| 7057 | fusionAlg_B.radarObj.radar_29_obj.objXPos = *rtu_Radar410_Info_st_x6C_3C_O_m; |
| 7058 | fusionAlg_B.radarObj.radar_29_obj.objYPos = *rtu_Radar410_Info_st_x6C_3C__mz; |
| 7059 | |
| 7060 | /* DataTypeConversion: '<S212>/Data Type Conversion' */ |
| 7061 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6D_3D_O_b); |
| 7062 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7063 | tmp = 0.0F; |
| 7064 | } else { |
| 7065 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 7066 | } |
| 7067 | |
| 7068 | fusionAlg_B.radarObj.radar_30_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 7069 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 7070 | |
| 7071 | /* End of DataTypeConversion: '<S212>/Data Type Conversion' */ |
| 7072 | |
| 7073 | /* DataTypeConversion: '<S212>/Data Type Conversion1' */ |
| 7074 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6D_3D__d5); |
| 7075 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7076 | tmp = 0.0F; |
| 7077 | } else { |
| 7078 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7079 | } |
| 7080 | |
| 7081 | fusionAlg_B.radarObj.radar_30_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 7082 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7083 | |
| 7084 | /* End of DataTypeConversion: '<S212>/Data Type Conversion1' */ |
| 7085 | |
| 7086 | /* DataTypeConversion: '<S212>/Data Type Conversion2' */ |
| 7087 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6D_3D__oq); |
| 7088 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7089 | tmp = 0.0F; |
| 7090 | } else { |
| 7091 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7092 | } |
| 7093 | |
| 7094 | fusionAlg_B.radarObj.radar_30_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 7095 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7096 | |
| 7097 | /* End of DataTypeConversion: '<S212>/Data Type Conversion2' */ |
| 7098 | |
| 7099 | /* DataTypeConversion: '<S212>/Data Type Conversion3' */ |
| 7100 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6D_3D_O_d); |
| 7101 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7102 | tmp = 0.0F; |
| 7103 | } else { |
| 7104 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7105 | } |
| 7106 | |
| 7107 | fusionAlg_B.radarObj.radar_30_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7108 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7109 | |
| 7110 | /* End of DataTypeConversion: '<S212>/Data Type Conversion3' */ |
| 7111 | |
| 7112 | /* DataTypeConversion: '<S212>/Data Type Conversion4' */ |
| 7113 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6D_3D__jt); |
| 7114 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7115 | tmp = 0.0F; |
| 7116 | } else { |
| 7117 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7118 | } |
| 7119 | |
| 7120 | fusionAlg_B.radarObj.radar_30_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7121 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7122 | |
| 7123 | /* End of DataTypeConversion: '<S212>/Data Type Conversion4' */ |
| 7124 | |
| 7125 | /* DataTypeConversion: '<S212>/Data Type Conversion5' */ |
| 7126 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6D_3D__jk); |
| 7127 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7128 | tmp = 0.0F; |
| 7129 | } else { |
| 7130 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7131 | } |
| 7132 | |
| 7133 | fusionAlg_B.radarObj.radar_30_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7134 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7135 | |
| 7136 | /* End of DataTypeConversion: '<S212>/Data Type Conversion5' */ |
| 7137 | |
| 7138 | /* BusCreator: '<S212>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7139 | * Constant: '<S212>/Constant' |
| 7140 | * Constant: '<S212>/Constant1' |
| 7141 | */ |
| 7142 | fusionAlg_B.radarObj.radar_30_obj.reserved.reserved1 = |
| 7143 | fusionAlg_P_g.Constant_Value_fp; |
| 7144 | fusionAlg_B.radarObj.radar_30_obj.reserved.reserved0 = |
| 7145 | fusionAlg_P_g.Constant1_Value_ds; |
| 7146 | |
| 7147 | /* BusCreator: '<S212>/Bus Creator1' */ |
| 7148 | fusionAlg_B.radarObj.radar_30_obj.objObstacleProb = |
| 7149 | *rtu_Radar410_Info_st_x6D_3D_O_g; |
| 7150 | fusionAlg_B.radarObj.radar_30_obj.objXPos_Stdev = |
| 7151 | *rtu_Radar410_Info_st_x6D_3D_O_m; |
| 7152 | fusionAlg_B.radarObj.radar_30_obj.objYPos_Stdev = |
| 7153 | *rtu_Radar410_Info_st_x6D_3D_O_o; |
| 7154 | fusionAlg_B.radarObj.radar_30_obj.objXVelRel_Stdev = |
| 7155 | *rtu_Radar410_Info_st_x6D_3D_O_i; |
| 7156 | fusionAlg_B.radarObj.radar_30_obj.objXAccRel = |
| 7157 | *rtu_Radar410_Info_st_x6D_3D_O_j; |
| 7158 | fusionAlg_B.radarObj.radar_30_obj.objExstProb = |
| 7159 | *rtu_Radar410_Info_st_x6D_3D_Obj; |
| 7160 | fusionAlg_B.radarObj.radar_30_obj.objYVelRel = |
| 7161 | *rtu_Radar410_Info_st_x6D_3D_O_p; |
| 7162 | fusionAlg_B.radarObj.radar_30_obj.objXVelRel = |
| 7163 | *rtu_Radar410_Info_st_x6D_3D_O_a; |
| 7164 | fusionAlg_B.radarObj.radar_30_obj.objXPos = *rtu_Radar410_Info_st_x6D_3D__iy; |
| 7165 | fusionAlg_B.radarObj.radar_30_obj.objYPos = *rtu_Radar410_Info_st_x6D_3D__j4; |
| 7166 | |
| 7167 | /* DataTypeConversion: '<S213>/Data Type Conversion' */ |
| 7168 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6E_3E__h1); |
| 7169 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7170 | tmp = 0.0F; |
| 7171 | } else { |
| 7172 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 7173 | } |
| 7174 | |
| 7175 | fusionAlg_B.radarObj.radar_31_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 7176 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 7177 | |
| 7178 | /* End of DataTypeConversion: '<S213>/Data Type Conversion' */ |
| 7179 | |
| 7180 | /* DataTypeConversion: '<S213>/Data Type Conversion1' */ |
| 7181 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6E_3E_O_h); |
| 7182 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7183 | tmp = 0.0F; |
| 7184 | } else { |
| 7185 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7186 | } |
| 7187 | |
| 7188 | fusionAlg_B.radarObj.radar_31_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 7189 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7190 | |
| 7191 | /* End of DataTypeConversion: '<S213>/Data Type Conversion1' */ |
| 7192 | |
| 7193 | /* DataTypeConversion: '<S213>/Data Type Conversion2' */ |
| 7194 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6E_3E_O_d); |
| 7195 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7196 | tmp = 0.0F; |
| 7197 | } else { |
| 7198 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7199 | } |
| 7200 | |
| 7201 | fusionAlg_B.radarObj.radar_31_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 7202 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7203 | |
| 7204 | /* End of DataTypeConversion: '<S213>/Data Type Conversion2' */ |
| 7205 | |
| 7206 | /* DataTypeConversion: '<S213>/Data Type Conversion3' */ |
| 7207 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6E_3E_O_c); |
| 7208 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7209 | tmp = 0.0F; |
| 7210 | } else { |
| 7211 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7212 | } |
| 7213 | |
| 7214 | fusionAlg_B.radarObj.radar_31_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7215 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7216 | |
| 7217 | /* End of DataTypeConversion: '<S213>/Data Type Conversion3' */ |
| 7218 | |
| 7219 | /* DataTypeConversion: '<S213>/Data Type Conversion4' */ |
| 7220 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6E_3E_O_g); |
| 7221 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7222 | tmp = 0.0F; |
| 7223 | } else { |
| 7224 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7225 | } |
| 7226 | |
| 7227 | fusionAlg_B.radarObj.radar_31_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7228 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7229 | |
| 7230 | /* End of DataTypeConversion: '<S213>/Data Type Conversion4' */ |
| 7231 | |
| 7232 | /* DataTypeConversion: '<S213>/Data Type Conversion5' */ |
| 7233 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6E_3E_O_k); |
| 7234 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7235 | tmp = 0.0F; |
| 7236 | } else { |
| 7237 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7238 | } |
| 7239 | |
| 7240 | fusionAlg_B.radarObj.radar_31_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7241 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7242 | |
| 7243 | /* End of DataTypeConversion: '<S213>/Data Type Conversion5' */ |
| 7244 | |
| 7245 | /* BusCreator: '<S213>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7246 | * Constant: '<S213>/Constant' |
| 7247 | * Constant: '<S213>/Constant1' |
| 7248 | */ |
| 7249 | fusionAlg_B.radarObj.radar_31_obj.reserved.reserved1 = |
| 7250 | fusionAlg_P_g.Constant_Value_i1; |
| 7251 | fusionAlg_B.radarObj.radar_31_obj.reserved.reserved0 = |
| 7252 | fusionAlg_P_g.Constant1_Value_m5; |
| 7253 | |
| 7254 | /* BusCreator: '<S213>/Bus Creator1' */ |
| 7255 | fusionAlg_B.radarObj.radar_31_obj.objObstacleProb = |
| 7256 | *rtu_Radar410_Info_st_x6E_3E_O_i; |
| 7257 | fusionAlg_B.radarObj.radar_31_obj.objXPos_Stdev = |
| 7258 | *rtu_Radar410_Info_st_x6E_3E__nx; |
| 7259 | fusionAlg_B.radarObj.radar_31_obj.objYPos_Stdev = |
| 7260 | *rtu_Radar410_Info_st_x6E_3E_O_o; |
| 7261 | fusionAlg_B.radarObj.radar_31_obj.objXVelRel_Stdev = |
| 7262 | *rtu_Radar410_Info_st_x6E_3E_O_e; |
| 7263 | fusionAlg_B.radarObj.radar_31_obj.objXAccRel = |
| 7264 | *rtu_Radar410_Info_st_x6E_3E_O_n; |
| 7265 | fusionAlg_B.radarObj.radar_31_obj.objExstProb = |
| 7266 | *rtu_Radar410_Info_st_x6E_3E_Obj; |
| 7267 | fusionAlg_B.radarObj.radar_31_obj.objYVelRel = |
| 7268 | *rtu_Radar410_Info_st_x6E_3E_O_f; |
| 7269 | fusionAlg_B.radarObj.radar_31_obj.objXVelRel = |
| 7270 | *rtu_Radar410_Info_st_x6E_3E_O_b; |
| 7271 | fusionAlg_B.radarObj.radar_31_obj.objXPos = *rtu_Radar410_Info_st_x6E_3E_h1d; |
| 7272 | fusionAlg_B.radarObj.radar_31_obj.objYPos = *rtu_Radar410_Info_st_x6E_3E__o4; |
| 7273 | |
| 7274 | /* DataTypeConversion: '<S214>/Data Type Conversion' */ |
| 7275 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6F_3F_O_m); |
| 7276 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7277 | tmp = 0.0F; |
| 7278 | } else { |
| 7279 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 7280 | } |
| 7281 | |
| 7282 | fusionAlg_B.radarObj.radar_32_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 7283 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 7284 | |
| 7285 | /* End of DataTypeConversion: '<S214>/Data Type Conversion' */ |
| 7286 | |
| 7287 | /* DataTypeConversion: '<S214>/Data Type Conversion1' */ |
| 7288 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6F_3F__gc); |
| 7289 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7290 | tmp = 0.0F; |
| 7291 | } else { |
| 7292 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7293 | } |
| 7294 | |
| 7295 | fusionAlg_B.radarObj.radar_32_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 7296 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7297 | |
| 7298 | /* End of DataTypeConversion: '<S214>/Data Type Conversion1' */ |
| 7299 | |
| 7300 | /* DataTypeConversion: '<S214>/Data Type Conversion2' */ |
| 7301 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6F_3F_O_n); |
| 7302 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7303 | tmp = 0.0F; |
| 7304 | } else { |
| 7305 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7306 | } |
| 7307 | |
| 7308 | fusionAlg_B.radarObj.radar_32_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 7309 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7310 | |
| 7311 | /* End of DataTypeConversion: '<S214>/Data Type Conversion2' */ |
| 7312 | |
| 7313 | /* DataTypeConversion: '<S214>/Data Type Conversion3' */ |
| 7314 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6F_3F_O_k); |
| 7315 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7316 | tmp = 0.0F; |
| 7317 | } else { |
| 7318 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7319 | } |
| 7320 | |
| 7321 | fusionAlg_B.radarObj.radar_32_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7322 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7323 | |
| 7324 | /* End of DataTypeConversion: '<S214>/Data Type Conversion3' */ |
| 7325 | |
| 7326 | /* DataTypeConversion: '<S214>/Data Type Conversion4' */ |
| 7327 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6F_3F__gu); |
| 7328 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7329 | tmp = 0.0F; |
| 7330 | } else { |
| 7331 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7332 | } |
| 7333 | |
| 7334 | fusionAlg_B.radarObj.radar_32_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7335 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7336 | |
| 7337 | /* End of DataTypeConversion: '<S214>/Data Type Conversion4' */ |
| 7338 | |
| 7339 | /* DataTypeConversion: '<S214>/Data Type Conversion5' */ |
| 7340 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x6F_3F_O_c); |
| 7341 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7342 | tmp = 0.0F; |
| 7343 | } else { |
| 7344 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7345 | } |
| 7346 | |
| 7347 | fusionAlg_B.radarObj.radar_32_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7348 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7349 | |
| 7350 | /* End of DataTypeConversion: '<S214>/Data Type Conversion5' */ |
| 7351 | |
| 7352 | /* BusCreator: '<S214>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7353 | * Constant: '<S214>/Constant' |
| 7354 | * Constant: '<S214>/Constant1' |
| 7355 | */ |
| 7356 | fusionAlg_B.radarObj.radar_32_obj.reserved.reserved1 = |
| 7357 | fusionAlg_P_g.Constant_Value_jt; |
| 7358 | fusionAlg_B.radarObj.radar_32_obj.reserved.reserved0 = |
| 7359 | fusionAlg_P_g.Constant1_Value_ng; |
| 7360 | |
| 7361 | /* BusCreator: '<S214>/Bus Creator1' */ |
| 7362 | fusionAlg_B.radarObj.radar_32_obj.objObstacleProb = |
| 7363 | *rtu_Radar410_Info_st_x6F_3F_O_h; |
| 7364 | fusionAlg_B.radarObj.radar_32_obj.objXPos_Stdev = |
| 7365 | *rtu_Radar410_Info_st_x6F_3F__n1; |
| 7366 | fusionAlg_B.radarObj.radar_32_obj.objYPos_Stdev = |
| 7367 | *rtu_Radar410_Info_st_x6F_3F__gj; |
| 7368 | fusionAlg_B.radarObj.radar_32_obj.objXVelRel_Stdev = |
| 7369 | *rtu_Radar410_Info_st_x6F_3F_O_g; |
| 7370 | fusionAlg_B.radarObj.radar_32_obj.objXAccRel = |
| 7371 | *rtu_Radar410_Info_st_x6F_3F_O_b; |
| 7372 | fusionAlg_B.radarObj.radar_32_obj.objExstProb = |
| 7373 | *rtu_Radar410_Info_st_x6F_3F_Obj; |
| 7374 | fusionAlg_B.radarObj.radar_32_obj.objYVelRel = |
| 7375 | *rtu_Radar410_Info_st_x6F_3F_O_e; |
| 7376 | fusionAlg_B.radarObj.radar_32_obj.objXVelRel = |
| 7377 | *rtu_Radar410_Info_st_x6F_3F_O_l; |
| 7378 | fusionAlg_B.radarObj.radar_32_obj.objXPos = *rtu_Radar410_Info_st_x6F_3F_O_i; |
| 7379 | fusionAlg_B.radarObj.radar_32_obj.objYPos = *rtu_Radar410_Info_st_x6F_3F_O_a; |
| 7380 | |
| 7381 | /* DataTypeConversion: '<S215>/Data Type Conversion' */ |
| 7382 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x70_40_O_h); |
| 7383 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7384 | tmp = 0.0F; |
| 7385 | } else { |
| 7386 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 7387 | } |
| 7388 | |
| 7389 | fusionAlg_B.radarObj.radar_33_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 7390 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 7391 | |
| 7392 | /* End of DataTypeConversion: '<S215>/Data Type Conversion' */ |
| 7393 | |
| 7394 | /* DataTypeConversion: '<S215>/Data Type Conversion1' */ |
| 7395 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x70_40_O_c); |
| 7396 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7397 | tmp = 0.0F; |
| 7398 | } else { |
| 7399 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7400 | } |
| 7401 | |
| 7402 | fusionAlg_B.radarObj.radar_33_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 7403 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7404 | |
| 7405 | /* End of DataTypeConversion: '<S215>/Data Type Conversion1' */ |
| 7406 | |
| 7407 | /* DataTypeConversion: '<S215>/Data Type Conversion2' */ |
| 7408 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x70_40__ih); |
| 7409 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7410 | tmp = 0.0F; |
| 7411 | } else { |
| 7412 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7413 | } |
| 7414 | |
| 7415 | fusionAlg_B.radarObj.radar_33_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 7416 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7417 | |
| 7418 | /* End of DataTypeConversion: '<S215>/Data Type Conversion2' */ |
| 7419 | |
| 7420 | /* DataTypeConversion: '<S215>/Data Type Conversion3' */ |
| 7421 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x70_40__ms); |
| 7422 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7423 | tmp = 0.0F; |
| 7424 | } else { |
| 7425 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7426 | } |
| 7427 | |
| 7428 | fusionAlg_B.radarObj.radar_33_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7429 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7430 | |
| 7431 | /* End of DataTypeConversion: '<S215>/Data Type Conversion3' */ |
| 7432 | |
| 7433 | /* DataTypeConversion: '<S215>/Data Type Conversion4' */ |
| 7434 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x70_40__fv); |
| 7435 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7436 | tmp = 0.0F; |
| 7437 | } else { |
| 7438 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7439 | } |
| 7440 | |
| 7441 | fusionAlg_B.radarObj.radar_33_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7442 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7443 | |
| 7444 | /* End of DataTypeConversion: '<S215>/Data Type Conversion4' */ |
| 7445 | |
| 7446 | /* DataTypeConversion: '<S215>/Data Type Conversion5' */ |
| 7447 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x70_40_O_f); |
| 7448 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7449 | tmp = 0.0F; |
| 7450 | } else { |
| 7451 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7452 | } |
| 7453 | |
| 7454 | fusionAlg_B.radarObj.radar_33_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7455 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7456 | |
| 7457 | /* End of DataTypeConversion: '<S215>/Data Type Conversion5' */ |
| 7458 | |
| 7459 | /* BusCreator: '<S215>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7460 | * Constant: '<S215>/Constant' |
| 7461 | * Constant: '<S215>/Constant1' |
| 7462 | */ |
| 7463 | fusionAlg_B.radarObj.radar_33_obj.reserved.reserved1 = |
| 7464 | fusionAlg_P_g.Constant_Value_lw; |
| 7465 | fusionAlg_B.radarObj.radar_33_obj.reserved.reserved0 = |
| 7466 | fusionAlg_P_g.Constant1_Value_oi; |
| 7467 | |
| 7468 | /* BusCreator: '<S215>/Bus Creator1' */ |
| 7469 | fusionAlg_B.radarObj.radar_33_obj.objObstacleProb = |
| 7470 | *rtu_Radar410_Info_st_x70_40_O_n; |
| 7471 | fusionAlg_B.radarObj.radar_33_obj.objXPos_Stdev = |
| 7472 | *rtu_Radar410_Info_st_x70_40_O_b; |
| 7473 | fusionAlg_B.radarObj.radar_33_obj.objYPos_Stdev = |
| 7474 | *rtu_Radar410_Info_st_x70_40_O_i; |
| 7475 | fusionAlg_B.radarObj.radar_33_obj.objXVelRel_Stdev = |
| 7476 | *rtu_Radar410_Info_st_x70_40_O_k; |
| 7477 | fusionAlg_B.radarObj.radar_33_obj.objXAccRel = |
| 7478 | *rtu_Radar410_Info_st_x70_40_O_m; |
| 7479 | fusionAlg_B.radarObj.radar_33_obj.objExstProb = |
| 7480 | *rtu_Radar410_Info_st_x70_40_Obj; |
| 7481 | fusionAlg_B.radarObj.radar_33_obj.objYVelRel = |
| 7482 | *rtu_Radar410_Info_st_x70_40__bd; |
| 7483 | fusionAlg_B.radarObj.radar_33_obj.objXVelRel = |
| 7484 | *rtu_Radar410_Info_st_x70_40_O_o; |
| 7485 | fusionAlg_B.radarObj.radar_33_obj.objXPos = *rtu_Radar410_Info_st_x70_40__bp; |
| 7486 | fusionAlg_B.radarObj.radar_33_obj.objYPos = *rtu_Radar410_Info_st_x70_40__f2; |
| 7487 | |
| 7488 | /* DataTypeConversion: '<S216>/Data Type Conversion' */ |
| 7489 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x71_41__ma); |
| 7490 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7491 | tmp = 0.0F; |
| 7492 | } else { |
| 7493 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 7494 | } |
| 7495 | |
| 7496 | fusionAlg_B.radarObj.radar_34_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 7497 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 7498 | |
| 7499 | /* End of DataTypeConversion: '<S216>/Data Type Conversion' */ |
| 7500 | |
| 7501 | /* DataTypeConversion: '<S216>/Data Type Conversion1' */ |
| 7502 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x71_41_O_g); |
| 7503 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7504 | tmp = 0.0F; |
| 7505 | } else { |
| 7506 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7507 | } |
| 7508 | |
| 7509 | fusionAlg_B.radarObj.radar_34_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 7510 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7511 | |
| 7512 | /* End of DataTypeConversion: '<S216>/Data Type Conversion1' */ |
| 7513 | |
| 7514 | /* DataTypeConversion: '<S216>/Data Type Conversion2' */ |
| 7515 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x71_41_O_f); |
| 7516 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7517 | tmp = 0.0F; |
| 7518 | } else { |
| 7519 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7520 | } |
| 7521 | |
| 7522 | fusionAlg_B.radarObj.radar_34_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 7523 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7524 | |
| 7525 | /* End of DataTypeConversion: '<S216>/Data Type Conversion2' */ |
| 7526 | |
| 7527 | /* DataTypeConversion: '<S216>/Data Type Conversion3' */ |
| 7528 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x71_41_O_k); |
| 7529 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7530 | tmp = 0.0F; |
| 7531 | } else { |
| 7532 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7533 | } |
| 7534 | |
| 7535 | fusionAlg_B.radarObj.radar_34_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7536 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7537 | |
| 7538 | /* End of DataTypeConversion: '<S216>/Data Type Conversion3' */ |
| 7539 | |
| 7540 | /* DataTypeConversion: '<S216>/Data Type Conversion4' */ |
| 7541 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x71_41__ha); |
| 7542 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7543 | tmp = 0.0F; |
| 7544 | } else { |
| 7545 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7546 | } |
| 7547 | |
| 7548 | fusionAlg_B.radarObj.radar_34_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7549 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7550 | |
| 7551 | /* End of DataTypeConversion: '<S216>/Data Type Conversion4' */ |
| 7552 | |
| 7553 | /* DataTypeConversion: '<S216>/Data Type Conversion5' */ |
| 7554 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x71_41_O_e); |
| 7555 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7556 | tmp = 0.0F; |
| 7557 | } else { |
| 7558 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7559 | } |
| 7560 | |
| 7561 | fusionAlg_B.radarObj.radar_34_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7562 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7563 | |
| 7564 | /* End of DataTypeConversion: '<S216>/Data Type Conversion5' */ |
| 7565 | |
| 7566 | /* BusCreator: '<S216>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7567 | * Constant: '<S216>/Constant' |
| 7568 | * Constant: '<S216>/Constant1' |
| 7569 | */ |
| 7570 | fusionAlg_B.radarObj.radar_34_obj.reserved.reserved1 = |
| 7571 | fusionAlg_P_g.Constant_Value_ab; |
| 7572 | fusionAlg_B.radarObj.radar_34_obj.reserved.reserved0 = |
| 7573 | fusionAlg_P_g.Constant1_Value_ow; |
| 7574 | |
| 7575 | /* BusCreator: '<S216>/Bus Creator1' */ |
| 7576 | fusionAlg_B.radarObj.radar_34_obj.objObstacleProb = |
| 7577 | *rtu_Radar410_Info_st_x71_41_O_l; |
| 7578 | fusionAlg_B.radarObj.radar_34_obj.objXPos_Stdev = |
| 7579 | *rtu_Radar410_Info_st_x71_41_O_h; |
| 7580 | fusionAlg_B.radarObj.radar_34_obj.objYPos_Stdev = |
| 7581 | *rtu_Radar410_Info_st_x71_41__lp; |
| 7582 | fusionAlg_B.radarObj.radar_34_obj.objXVelRel_Stdev = |
| 7583 | *rtu_Radar410_Info_st_x71_41_O_m; |
| 7584 | fusionAlg_B.radarObj.radar_34_obj.objXAccRel = |
| 7585 | *rtu_Radar410_Info_st_x71_41_O_c; |
| 7586 | fusionAlg_B.radarObj.radar_34_obj.objExstProb = |
| 7587 | *rtu_Radar410_Info_st_x71_41_Obj; |
| 7588 | fusionAlg_B.radarObj.radar_34_obj.objYVelRel = |
| 7589 | *rtu_Radar410_Info_st_x71_41_O_b; |
| 7590 | fusionAlg_B.radarObj.radar_34_obj.objXVelRel = |
| 7591 | *rtu_Radar410_Info_st_x71_41__ev; |
| 7592 | fusionAlg_B.radarObj.radar_34_obj.objXPos = *rtu_Radar410_Info_st_x71_41_O_j; |
| 7593 | fusionAlg_B.radarObj.radar_34_obj.objYPos = *rtu_Radar410_Info_st_x71_41_O_p; |
| 7594 | |
| 7595 | /* DataTypeConversion: '<S200>/Data Type Conversion' */ |
| 7596 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x72_42_O_l); |
| 7597 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7598 | tmp = 0.0F; |
| 7599 | } else { |
| 7600 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 7601 | } |
| 7602 | |
| 7603 | fusionAlg_B.radarObj.radar_35_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 7604 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 7605 | |
| 7606 | /* End of DataTypeConversion: '<S200>/Data Type Conversion' */ |
| 7607 | |
| 7608 | /* DataTypeConversion: '<S200>/Data Type Conversion1' */ |
| 7609 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x72_42_O_f); |
| 7610 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7611 | tmp = 0.0F; |
| 7612 | } else { |
| 7613 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7614 | } |
| 7615 | |
| 7616 | fusionAlg_B.radarObj.radar_35_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 7617 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7618 | |
| 7619 | /* End of DataTypeConversion: '<S200>/Data Type Conversion1' */ |
| 7620 | |
| 7621 | /* DataTypeConversion: '<S200>/Data Type Conversion2' */ |
| 7622 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x72_42_O_k); |
| 7623 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7624 | tmp = 0.0F; |
| 7625 | } else { |
| 7626 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7627 | } |
| 7628 | |
| 7629 | fusionAlg_B.radarObj.radar_35_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 7630 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7631 | |
| 7632 | /* End of DataTypeConversion: '<S200>/Data Type Conversion2' */ |
| 7633 | |
| 7634 | /* DataTypeConversion: '<S200>/Data Type Conversion3' */ |
| 7635 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x72_42_O_h); |
| 7636 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7637 | tmp = 0.0F; |
| 7638 | } else { |
| 7639 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7640 | } |
| 7641 | |
| 7642 | fusionAlg_B.radarObj.radar_35_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7643 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7644 | |
| 7645 | /* End of DataTypeConversion: '<S200>/Data Type Conversion3' */ |
| 7646 | |
| 7647 | /* DataTypeConversion: '<S200>/Data Type Conversion4' */ |
| 7648 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x72_42__ag); |
| 7649 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7650 | tmp = 0.0F; |
| 7651 | } else { |
| 7652 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7653 | } |
| 7654 | |
| 7655 | fusionAlg_B.radarObj.radar_35_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7656 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7657 | |
| 7658 | /* End of DataTypeConversion: '<S200>/Data Type Conversion4' */ |
| 7659 | |
| 7660 | /* DataTypeConversion: '<S200>/Data Type Conversion5' */ |
| 7661 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x72_42__mh); |
| 7662 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7663 | tmp = 0.0F; |
| 7664 | } else { |
| 7665 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7666 | } |
| 7667 | |
| 7668 | fusionAlg_B.radarObj.radar_35_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7669 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7670 | |
| 7671 | /* End of DataTypeConversion: '<S200>/Data Type Conversion5' */ |
| 7672 | |
| 7673 | /* BusCreator: '<S200>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7674 | * Constant: '<S200>/Constant' |
| 7675 | * Constant: '<S200>/Constant1' |
| 7676 | */ |
| 7677 | fusionAlg_B.radarObj.radar_35_obj.reserved.reserved1 = |
| 7678 | fusionAlg_P_g.Constant_Value_bi; |
| 7679 | fusionAlg_B.radarObj.radar_35_obj.reserved.reserved0 = |
| 7680 | fusionAlg_P_g.Constant1_Value_l4; |
| 7681 | |
| 7682 | /* BusCreator: '<S200>/Bus Creator1' */ |
| 7683 | fusionAlg_B.radarObj.radar_35_obj.objObstacleProb = |
| 7684 | *rtu_Radar410_Info_st_x72_42_O_m; |
| 7685 | fusionAlg_B.radarObj.radar_35_obj.objXPos_Stdev = |
| 7686 | *rtu_Radar410_Info_st_x72_42_O_e; |
| 7687 | fusionAlg_B.radarObj.radar_35_obj.objYPos_Stdev = |
| 7688 | *rtu_Radar410_Info_st_x72_42_O_n; |
| 7689 | fusionAlg_B.radarObj.radar_35_obj.objXVelRel_Stdev = |
| 7690 | *rtu_Radar410_Info_st_x72_42_O_a; |
| 7691 | fusionAlg_B.radarObj.radar_35_obj.objXAccRel = |
| 7692 | *rtu_Radar410_Info_st_x72_42_O_b; |
| 7693 | fusionAlg_B.radarObj.radar_35_obj.objExstProb = |
| 7694 | *rtu_Radar410_Info_st_x72_42_Obj; |
| 7695 | fusionAlg_B.radarObj.radar_35_obj.objYVelRel = |
| 7696 | *rtu_Radar410_Info_st_x72_42__ly; |
| 7697 | fusionAlg_B.radarObj.radar_35_obj.objXVelRel = |
| 7698 | *rtu_Radar410_Info_st_x72_42__fn; |
| 7699 | fusionAlg_B.radarObj.radar_35_obj.objXPos = *rtu_Radar410_Info_st_x72_42__mf; |
| 7700 | fusionAlg_B.radarObj.radar_35_obj.objYPos = *rtu_Radar410_Info_st_x72_42__nk; |
| 7701 | |
| 7702 | /* DataTypeConversion: '<S201>/Data Type Conversion' */ |
| 7703 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x73_43__dw); |
| 7704 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7705 | tmp = 0.0F; |
| 7706 | } else { |
| 7707 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 7708 | } |
| 7709 | |
| 7710 | fusionAlg_B.radarObj.radar_36_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 7711 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 7712 | |
| 7713 | /* End of DataTypeConversion: '<S201>/Data Type Conversion' */ |
| 7714 | |
| 7715 | /* DataTypeConversion: '<S201>/Data Type Conversion1' */ |
| 7716 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x73_43_O_e); |
| 7717 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7718 | tmp = 0.0F; |
| 7719 | } else { |
| 7720 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7721 | } |
| 7722 | |
| 7723 | fusionAlg_B.radarObj.radar_36_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 7724 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7725 | |
| 7726 | /* End of DataTypeConversion: '<S201>/Data Type Conversion1' */ |
| 7727 | |
| 7728 | /* DataTypeConversion: '<S201>/Data Type Conversion2' */ |
| 7729 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x73_43_O_d); |
| 7730 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7731 | tmp = 0.0F; |
| 7732 | } else { |
| 7733 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7734 | } |
| 7735 | |
| 7736 | fusionAlg_B.radarObj.radar_36_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 7737 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7738 | |
| 7739 | /* End of DataTypeConversion: '<S201>/Data Type Conversion2' */ |
| 7740 | |
| 7741 | /* DataTypeConversion: '<S201>/Data Type Conversion3' */ |
| 7742 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x73_43_O_b); |
| 7743 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7744 | tmp = 0.0F; |
| 7745 | } else { |
| 7746 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7747 | } |
| 7748 | |
| 7749 | fusionAlg_B.radarObj.radar_36_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7750 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7751 | |
| 7752 | /* End of DataTypeConversion: '<S201>/Data Type Conversion3' */ |
| 7753 | |
| 7754 | /* DataTypeConversion: '<S201>/Data Type Conversion4' */ |
| 7755 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x73_43__em); |
| 7756 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7757 | tmp = 0.0F; |
| 7758 | } else { |
| 7759 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7760 | } |
| 7761 | |
| 7762 | fusionAlg_B.radarObj.radar_36_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7763 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7764 | |
| 7765 | /* End of DataTypeConversion: '<S201>/Data Type Conversion4' */ |
| 7766 | |
| 7767 | /* DataTypeConversion: '<S201>/Data Type Conversion5' */ |
| 7768 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x73_43__fs); |
| 7769 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7770 | tmp = 0.0F; |
| 7771 | } else { |
| 7772 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7773 | } |
| 7774 | |
| 7775 | fusionAlg_B.radarObj.radar_36_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7776 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7777 | |
| 7778 | /* End of DataTypeConversion: '<S201>/Data Type Conversion5' */ |
| 7779 | |
| 7780 | /* BusCreator: '<S201>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7781 | * Constant: '<S201>/Constant' |
| 7782 | * Constant: '<S201>/Constant1' |
| 7783 | */ |
| 7784 | fusionAlg_B.radarObj.radar_36_obj.reserved.reserved1 = |
| 7785 | fusionAlg_P_g.Constant_Value_du; |
| 7786 | fusionAlg_B.radarObj.radar_36_obj.reserved.reserved0 = |
| 7787 | fusionAlg_P_g.Constant1_Value_bc; |
| 7788 | |
| 7789 | /* BusCreator: '<S201>/Bus Creator1' */ |
| 7790 | fusionAlg_B.radarObj.radar_36_obj.objObstacleProb = |
| 7791 | *rtu_Radar410_Info_st_x73_43_O_f; |
| 7792 | fusionAlg_B.radarObj.radar_36_obj.objXPos_Stdev = |
| 7793 | *rtu_Radar410_Info_st_x73_43_O_p; |
| 7794 | fusionAlg_B.radarObj.radar_36_obj.objYPos_Stdev = |
| 7795 | *rtu_Radar410_Info_st_x73_43_O_g; |
| 7796 | fusionAlg_B.radarObj.radar_36_obj.objXVelRel_Stdev = |
| 7797 | *rtu_Radar410_Info_st_x73_43_O_l; |
| 7798 | fusionAlg_B.radarObj.radar_36_obj.objXAccRel = |
| 7799 | *rtu_Radar410_Info_st_x73_43__ll; |
| 7800 | fusionAlg_B.radarObj.radar_36_obj.objExstProb = |
| 7801 | *rtu_Radar410_Info_st_x73_43_Obj; |
| 7802 | fusionAlg_B.radarObj.radar_36_obj.objYVelRel = |
| 7803 | *rtu_Radar410_Info_st_x73_43_O_o; |
| 7804 | fusionAlg_B.radarObj.radar_36_obj.objXVelRel = |
| 7805 | *rtu_Radar410_Info_st_x73_43__f1; |
| 7806 | fusionAlg_B.radarObj.radar_36_obj.objXPos = *rtu_Radar410_Info_st_x73_43__lh; |
| 7807 | fusionAlg_B.radarObj.radar_36_obj.objYPos = *rtu_Radar410_Info_st_x73_43__gf; |
| 7808 | |
| 7809 | /* DataTypeConversion: '<S202>/Data Type Conversion' */ |
| 7810 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x74_44_O_h); |
| 7811 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7812 | tmp = 0.0F; |
| 7813 | } else { |
| 7814 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 7815 | } |
| 7816 | |
| 7817 | fusionAlg_B.radarObj.radar_37_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 7818 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 7819 | |
| 7820 | /* End of DataTypeConversion: '<S202>/Data Type Conversion' */ |
| 7821 | |
| 7822 | /* DataTypeConversion: '<S202>/Data Type Conversion1' */ |
| 7823 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x74_44_O_m); |
| 7824 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7825 | tmp = 0.0F; |
| 7826 | } else { |
| 7827 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7828 | } |
| 7829 | |
| 7830 | fusionAlg_B.radarObj.radar_37_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 7831 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7832 | |
| 7833 | /* End of DataTypeConversion: '<S202>/Data Type Conversion1' */ |
| 7834 | |
| 7835 | /* DataTypeConversion: '<S202>/Data Type Conversion2' */ |
| 7836 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x74_44_O_n); |
| 7837 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7838 | tmp = 0.0F; |
| 7839 | } else { |
| 7840 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7841 | } |
| 7842 | |
| 7843 | fusionAlg_B.radarObj.radar_37_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 7844 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7845 | |
| 7846 | /* End of DataTypeConversion: '<S202>/Data Type Conversion2' */ |
| 7847 | |
| 7848 | /* DataTypeConversion: '<S202>/Data Type Conversion3' */ |
| 7849 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x74_44_O_p); |
| 7850 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7851 | tmp = 0.0F; |
| 7852 | } else { |
| 7853 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7854 | } |
| 7855 | |
| 7856 | fusionAlg_B.radarObj.radar_37_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7857 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7858 | |
| 7859 | /* End of DataTypeConversion: '<S202>/Data Type Conversion3' */ |
| 7860 | |
| 7861 | /* DataTypeConversion: '<S202>/Data Type Conversion4' */ |
| 7862 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x74_44__my); |
| 7863 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7864 | tmp = 0.0F; |
| 7865 | } else { |
| 7866 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7867 | } |
| 7868 | |
| 7869 | fusionAlg_B.radarObj.radar_37_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7870 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7871 | |
| 7872 | /* End of DataTypeConversion: '<S202>/Data Type Conversion4' */ |
| 7873 | |
| 7874 | /* DataTypeConversion: '<S202>/Data Type Conversion5' */ |
| 7875 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x74_44_O_j); |
| 7876 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7877 | tmp = 0.0F; |
| 7878 | } else { |
| 7879 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7880 | } |
| 7881 | |
| 7882 | fusionAlg_B.radarObj.radar_37_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7883 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7884 | |
| 7885 | /* End of DataTypeConversion: '<S202>/Data Type Conversion5' */ |
| 7886 | |
| 7887 | /* BusCreator: '<S202>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7888 | * Constant: '<S202>/Constant' |
| 7889 | * Constant: '<S202>/Constant1' |
| 7890 | */ |
| 7891 | fusionAlg_B.radarObj.radar_37_obj.reserved.reserved1 = |
| 7892 | fusionAlg_P_g.Constant_Value_o1; |
| 7893 | fusionAlg_B.radarObj.radar_37_obj.reserved.reserved0 = |
| 7894 | fusionAlg_P_g.Constant1_Value_dj; |
| 7895 | |
| 7896 | /* BusCreator: '<S202>/Bus Creator1' */ |
| 7897 | fusionAlg_B.radarObj.radar_37_obj.objObstacleProb = |
| 7898 | *rtu_Radar410_Info_st_x74_44_O_e; |
| 7899 | fusionAlg_B.radarObj.radar_37_obj.objXPos_Stdev = |
| 7900 | *rtu_Radar410_Info_st_x74_44__nd; |
| 7901 | fusionAlg_B.radarObj.radar_37_obj.objYPos_Stdev = |
| 7902 | *rtu_Radar410_Info_st_x74_44_O_a; |
| 7903 | fusionAlg_B.radarObj.radar_37_obj.objXVelRel_Stdev = |
| 7904 | *rtu_Radar410_Info_st_x74_44_O_c; |
| 7905 | fusionAlg_B.radarObj.radar_37_obj.objXAccRel = |
| 7906 | *rtu_Radar410_Info_st_x74_44_O_g; |
| 7907 | fusionAlg_B.radarObj.radar_37_obj.objExstProb = |
| 7908 | *rtu_Radar410_Info_st_x74_44_Obj; |
| 7909 | fusionAlg_B.radarObj.radar_37_obj.objYVelRel = |
| 7910 | *rtu_Radar410_Info_st_x74_44_O_b; |
| 7911 | fusionAlg_B.radarObj.radar_37_obj.objXVelRel = |
| 7912 | *rtu_Radar410_Info_st_x74_44_O_k; |
| 7913 | fusionAlg_B.radarObj.radar_37_obj.objXPos = *rtu_Radar410_Info_st_x74_44__g5; |
| 7914 | fusionAlg_B.radarObj.radar_37_obj.objYPos = *rtu_Radar410_Info_st_x74_44__eq; |
| 7915 | |
| 7916 | /* DataTypeConversion: '<S203>/Data Type Conversion' */ |
| 7917 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x75_45_O_j); |
| 7918 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7919 | tmp = 0.0F; |
| 7920 | } else { |
| 7921 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 7922 | } |
| 7923 | |
| 7924 | fusionAlg_B.radarObj.radar_38_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 7925 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 7926 | |
| 7927 | /* End of DataTypeConversion: '<S203>/Data Type Conversion' */ |
| 7928 | |
| 7929 | /* DataTypeConversion: '<S203>/Data Type Conversion1' */ |
| 7930 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x75_45_O_p); |
| 7931 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7932 | tmp = 0.0F; |
| 7933 | } else { |
| 7934 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7935 | } |
| 7936 | |
| 7937 | fusionAlg_B.radarObj.radar_38_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 7938 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7939 | |
| 7940 | /* End of DataTypeConversion: '<S203>/Data Type Conversion1' */ |
| 7941 | |
| 7942 | /* DataTypeConversion: '<S203>/Data Type Conversion2' */ |
| 7943 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x75_45__kf); |
| 7944 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7945 | tmp = 0.0F; |
| 7946 | } else { |
| 7947 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7948 | } |
| 7949 | |
| 7950 | fusionAlg_B.radarObj.radar_38_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 7951 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7952 | |
| 7953 | /* End of DataTypeConversion: '<S203>/Data Type Conversion2' */ |
| 7954 | |
| 7955 | /* DataTypeConversion: '<S203>/Data Type Conversion3' */ |
| 7956 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x75_45_O_n); |
| 7957 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7958 | tmp = 0.0F; |
| 7959 | } else { |
| 7960 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7961 | } |
| 7962 | |
| 7963 | fusionAlg_B.radarObj.radar_38_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 7964 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7965 | |
| 7966 | /* End of DataTypeConversion: '<S203>/Data Type Conversion3' */ |
| 7967 | |
| 7968 | /* DataTypeConversion: '<S203>/Data Type Conversion4' */ |
| 7969 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x75_45__l5); |
| 7970 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7971 | tmp = 0.0F; |
| 7972 | } else { |
| 7973 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7974 | } |
| 7975 | |
| 7976 | fusionAlg_B.radarObj.radar_38_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 7977 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7978 | |
| 7979 | /* End of DataTypeConversion: '<S203>/Data Type Conversion4' */ |
| 7980 | |
| 7981 | /* DataTypeConversion: '<S203>/Data Type Conversion5' */ |
| 7982 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x75_45_O_l); |
| 7983 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 7984 | tmp = 0.0F; |
| 7985 | } else { |
| 7986 | tmp = (real32_T)fmod(tmp, 256.0); |
| 7987 | } |
| 7988 | |
| 7989 | fusionAlg_B.radarObj.radar_38_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 7990 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 7991 | |
| 7992 | /* End of DataTypeConversion: '<S203>/Data Type Conversion5' */ |
| 7993 | |
| 7994 | /* BusCreator: '<S203>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 7995 | * Constant: '<S203>/Constant' |
| 7996 | * Constant: '<S203>/Constant1' |
| 7997 | */ |
| 7998 | fusionAlg_B.radarObj.radar_38_obj.reserved.reserved1 = |
| 7999 | fusionAlg_P_g.Constant_Value_mq; |
| 8000 | fusionAlg_B.radarObj.radar_38_obj.reserved.reserved0 = |
| 8001 | fusionAlg_P_g.Constant1_Value_ou; |
| 8002 | |
| 8003 | /* BusCreator: '<S203>/Bus Creator1' */ |
| 8004 | fusionAlg_B.radarObj.radar_38_obj.objObstacleProb = |
| 8005 | *rtu_Radar410_Info_st_x75_45_O_m; |
| 8006 | fusionAlg_B.radarObj.radar_38_obj.objXPos_Stdev = |
| 8007 | *rtu_Radar410_Info_st_x75_45_O_i; |
| 8008 | fusionAlg_B.radarObj.radar_38_obj.objYPos_Stdev = |
| 8009 | *rtu_Radar410_Info_st_x75_45_O_k; |
| 8010 | fusionAlg_B.radarObj.radar_38_obj.objXVelRel_Stdev = |
| 8011 | *rtu_Radar410_Info_st_x75_45_O_b; |
| 8012 | fusionAlg_B.radarObj.radar_38_obj.objXAccRel = |
| 8013 | *rtu_Radar410_Info_st_x75_45_O_g; |
| 8014 | fusionAlg_B.radarObj.radar_38_obj.objExstProb = |
| 8015 | *rtu_Radar410_Info_st_x75_45_Obj; |
| 8016 | fusionAlg_B.radarObj.radar_38_obj.objYVelRel = |
| 8017 | *rtu_Radar410_Info_st_x75_45__jl; |
| 8018 | fusionAlg_B.radarObj.radar_38_obj.objXVelRel = |
| 8019 | *rtu_Radar410_Info_st_x75_45__i4; |
| 8020 | fusionAlg_B.radarObj.radar_38_obj.objXPos = *rtu_Radar410_Info_st_x75_45__mo; |
| 8021 | fusionAlg_B.radarObj.radar_38_obj.objYPos = *rtu_Radar410_Info_st_x75_45__gp; |
| 8022 | |
| 8023 | /* DataTypeConversion: '<S205>/Data Type Conversion' */ |
| 8024 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x76_46__bq); |
| 8025 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8026 | tmp = 0.0F; |
| 8027 | } else { |
| 8028 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8029 | } |
| 8030 | |
| 8031 | fusionAlg_B.radarObj.radar_39_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 8032 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8033 | |
| 8034 | /* End of DataTypeConversion: '<S205>/Data Type Conversion' */ |
| 8035 | |
| 8036 | /* DataTypeConversion: '<S205>/Data Type Conversion1' */ |
| 8037 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x76_46__jw); |
| 8038 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8039 | tmp = 0.0F; |
| 8040 | } else { |
| 8041 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8042 | } |
| 8043 | |
| 8044 | fusionAlg_B.radarObj.radar_39_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 8045 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8046 | |
| 8047 | /* End of DataTypeConversion: '<S205>/Data Type Conversion1' */ |
| 8048 | |
| 8049 | /* DataTypeConversion: '<S205>/Data Type Conversion2' */ |
| 8050 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x76_46_O_j); |
| 8051 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8052 | tmp = 0.0F; |
| 8053 | } else { |
| 8054 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8055 | } |
| 8056 | |
| 8057 | fusionAlg_B.radarObj.radar_39_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 8058 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8059 | |
| 8060 | /* End of DataTypeConversion: '<S205>/Data Type Conversion2' */ |
| 8061 | |
| 8062 | /* DataTypeConversion: '<S205>/Data Type Conversion3' */ |
| 8063 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x76_46__l3); |
| 8064 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8065 | tmp = 0.0F; |
| 8066 | } else { |
| 8067 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8068 | } |
| 8069 | |
| 8070 | fusionAlg_B.radarObj.radar_39_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 8071 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8072 | |
| 8073 | /* End of DataTypeConversion: '<S205>/Data Type Conversion3' */ |
| 8074 | |
| 8075 | /* DataTypeConversion: '<S205>/Data Type Conversion4' */ |
| 8076 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x76_46__cc); |
| 8077 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8078 | tmp = 0.0F; |
| 8079 | } else { |
| 8080 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8081 | } |
| 8082 | |
| 8083 | fusionAlg_B.radarObj.radar_39_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 8084 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8085 | |
| 8086 | /* End of DataTypeConversion: '<S205>/Data Type Conversion4' */ |
| 8087 | |
| 8088 | /* DataTypeConversion: '<S205>/Data Type Conversion5' */ |
| 8089 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x76_46__bl); |
| 8090 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8091 | tmp = 0.0F; |
| 8092 | } else { |
| 8093 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8094 | } |
| 8095 | |
| 8096 | fusionAlg_B.radarObj.radar_39_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 8097 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8098 | |
| 8099 | /* End of DataTypeConversion: '<S205>/Data Type Conversion5' */ |
| 8100 | |
| 8101 | /* BusCreator: '<S205>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 8102 | * Constant: '<S205>/Constant' |
| 8103 | * Constant: '<S205>/Constant1' |
| 8104 | */ |
| 8105 | fusionAlg_B.radarObj.radar_39_obj.reserved.reserved1 = |
| 8106 | fusionAlg_P_g.Constant_Value_am; |
| 8107 | fusionAlg_B.radarObj.radar_39_obj.reserved.reserved0 = |
| 8108 | fusionAlg_P_g.Constant1_Value_nd; |
| 8109 | |
| 8110 | /* BusCreator: '<S205>/Bus Creator1' */ |
| 8111 | fusionAlg_B.radarObj.radar_39_obj.objObstacleProb = |
| 8112 | *rtu_Radar410_Info_st_x76_46_O_n; |
| 8113 | fusionAlg_B.radarObj.radar_39_obj.objXPos_Stdev = |
| 8114 | *rtu_Radar410_Info_st_x76_46_O_o; |
| 8115 | fusionAlg_B.radarObj.radar_39_obj.objYPos_Stdev = |
| 8116 | *rtu_Radar410_Info_st_x76_46_O_b; |
| 8117 | fusionAlg_B.radarObj.radar_39_obj.objXVelRel_Stdev = |
| 8118 | *rtu_Radar410_Info_st_x76_46_O_l; |
| 8119 | fusionAlg_B.radarObj.radar_39_obj.objXAccRel = |
| 8120 | *rtu_Radar410_Info_st_x76_46_O_g; |
| 8121 | fusionAlg_B.radarObj.radar_39_obj.objExstProb = |
| 8122 | *rtu_Radar410_Info_st_x76_46_Obj; |
| 8123 | fusionAlg_B.radarObj.radar_39_obj.objYVelRel = |
| 8124 | *rtu_Radar410_Info_st_x76_46_O_c; |
| 8125 | fusionAlg_B.radarObj.radar_39_obj.objXVelRel = |
| 8126 | *rtu_Radar410_Info_st_x76_46_O_m; |
| 8127 | fusionAlg_B.radarObj.radar_39_obj.objXPos = *rtu_Radar410_Info_st_x76_46__os; |
| 8128 | fusionAlg_B.radarObj.radar_39_obj.objYPos = *rtu_Radar410_Info_st_x76_46_O_k; |
| 8129 | |
| 8130 | /* DataTypeConversion: '<S206>/Data Type Conversion' */ |
| 8131 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x77_47_O_a); |
| 8132 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8133 | tmp = 0.0F; |
| 8134 | } else { |
| 8135 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8136 | } |
| 8137 | |
| 8138 | fusionAlg_B.radarObj.radar_40_obj.objID = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 8139 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8140 | |
| 8141 | /* End of DataTypeConversion: '<S206>/Data Type Conversion' */ |
| 8142 | |
| 8143 | /* DataTypeConversion: '<S206>/Data Type Conversion1' */ |
| 8144 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x77_47_O_f); |
| 8145 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8146 | tmp = 0.0F; |
| 8147 | } else { |
| 8148 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8149 | } |
| 8150 | |
| 8151 | fusionAlg_B.radarObj.radar_40_obj.objUpdateFlag = (uint8_T)(tmp < 0.0F ? |
| 8152 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8153 | |
| 8154 | /* End of DataTypeConversion: '<S206>/Data Type Conversion1' */ |
| 8155 | |
| 8156 | /* DataTypeConversion: '<S206>/Data Type Conversion2' */ |
| 8157 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x77_47_O_l); |
| 8158 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8159 | tmp = 0.0F; |
| 8160 | } else { |
| 8161 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8162 | } |
| 8163 | |
| 8164 | fusionAlg_B.radarObj.radar_40_obj.objValidFlag = (uint8_T)(tmp < 0.0F ? |
| 8165 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8166 | |
| 8167 | /* End of DataTypeConversion: '<S206>/Data Type Conversion2' */ |
| 8168 | |
| 8169 | /* DataTypeConversion: '<S206>/Data Type Conversion3' */ |
| 8170 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x77_47__go); |
| 8171 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8172 | tmp = 0.0F; |
| 8173 | } else { |
| 8174 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8175 | } |
| 8176 | |
| 8177 | fusionAlg_B.radarObj.radar_40_obj.objMotionPattern = (uint8_T)(tmp < 0.0F ? |
| 8178 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8179 | |
| 8180 | /* End of DataTypeConversion: '<S206>/Data Type Conversion3' */ |
| 8181 | |
| 8182 | /* DataTypeConversion: '<S206>/Data Type Conversion4' */ |
| 8183 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x77_47__fx); |
| 8184 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8185 | tmp = 0.0F; |
| 8186 | } else { |
| 8187 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8188 | } |
| 8189 | |
| 8190 | fusionAlg_B.radarObj.radar_40_obj.objType = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 8191 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8192 | |
| 8193 | /* End of DataTypeConversion: '<S206>/Data Type Conversion4' */ |
| 8194 | |
| 8195 | /* DataTypeConversion: '<S206>/Data Type Conversion5' */ |
| 8196 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x77_47_O_i); |
| 8197 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8198 | tmp = 0.0F; |
| 8199 | } else { |
| 8200 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8201 | } |
| 8202 | |
| 8203 | fusionAlg_B.radarObj.radar_40_obj.objMeasFlag = (uint8_T)(tmp < 0.0F ? |
| 8204 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8205 | |
| 8206 | /* End of DataTypeConversion: '<S206>/Data Type Conversion5' */ |
| 8207 | |
| 8208 | /* BusCreator: '<S206>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 8209 | * Constant: '<S206>/Constant' |
| 8210 | * Constant: '<S206>/Constant1' |
| 8211 | */ |
| 8212 | fusionAlg_B.radarObj.radar_40_obj.reserved.reserved1 = |
| 8213 | fusionAlg_P_g.Constant_Value_lo; |
| 8214 | fusionAlg_B.radarObj.radar_40_obj.reserved.reserved0 = |
| 8215 | fusionAlg_P_g.Constant1_Value_oc; |
| 8216 | |
| 8217 | /* BusCreator: '<S206>/Bus Creator1' */ |
| 8218 | fusionAlg_B.radarObj.radar_40_obj.objObstacleProb = |
| 8219 | *rtu_Radar410_Info_st_x77_47_O_e; |
| 8220 | fusionAlg_B.radarObj.radar_40_obj.objXPos_Stdev = |
| 8221 | *rtu_Radar410_Info_st_x77_47_O_j; |
| 8222 | fusionAlg_B.radarObj.radar_40_obj.objYPos_Stdev = |
| 8223 | *rtu_Radar410_Info_st_x77_47_O_h; |
| 8224 | fusionAlg_B.radarObj.radar_40_obj.objXVelRel_Stdev = |
| 8225 | *rtu_Radar410_Info_st_x77_47_O_g; |
| 8226 | fusionAlg_B.radarObj.radar_40_obj.objXAccRel = |
| 8227 | *rtu_Radar410_Info_st_x77_47_O_k; |
| 8228 | fusionAlg_B.radarObj.radar_40_obj.objExstProb = |
| 8229 | *rtu_Radar410_Info_st_x77_47_Obj; |
| 8230 | fusionAlg_B.radarObj.radar_40_obj.objYVelRel = |
| 8231 | *rtu_Radar410_Info_st_x77_47_O_p; |
| 8232 | fusionAlg_B.radarObj.radar_40_obj.objXVelRel = |
| 8233 | *rtu_Radar410_Info_st_x77_47__me; |
| 8234 | fusionAlg_B.radarObj.radar_40_obj.objXPos = *rtu_Radar410_Info_st_x77_47__ey; |
| 8235 | fusionAlg_B.radarObj.radar_40_obj.objYPos = *rtu_Radar410_Info_st_x77_47_O_m; |
| 8236 | |
| 8237 | /* DataTypeConversion: '<S209>/Data Type Conversion' */ |
| 8238 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x80_Sta_iy); |
| 8239 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8240 | tmp = 0.0F; |
| 8241 | } else { |
| 8242 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8243 | } |
| 8244 | |
| 8245 | fusionAlg_B.BusCreator1_fl.timeStamp = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 8246 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8247 | |
| 8248 | /* End of DataTypeConversion: '<S209>/Data Type Conversion' */ |
| 8249 | |
| 8250 | /* DataTypeConversion: '<S209>/Data Type Conversion1' */ |
| 8251 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x80_Stat_l); |
| 8252 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8253 | tmp = 0.0F; |
| 8254 | } else { |
| 8255 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8256 | } |
| 8257 | |
| 8258 | fusionAlg_B.BusCreator1_fl.statusHWErr = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 8259 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8260 | |
| 8261 | /* End of DataTypeConversion: '<S209>/Data Type Conversion1' */ |
| 8262 | |
| 8263 | /* DataTypeConversion: '<S209>/Data Type Conversion2' */ |
| 8264 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x80_Stat_h); |
| 8265 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8266 | tmp = 0.0F; |
| 8267 | } else { |
| 8268 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8269 | } |
| 8270 | |
| 8271 | fusionAlg_B.BusCreator1_fl.statusBlkProg = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 8272 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8273 | |
| 8274 | /* End of DataTypeConversion: '<S209>/Data Type Conversion2' */ |
| 8275 | |
| 8276 | /* DataTypeConversion: '<S209>/Data Type Conversion3' */ |
| 8277 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x80_Stat_d); |
| 8278 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8279 | tmp = 0.0F; |
| 8280 | } else { |
| 8281 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8282 | } |
| 8283 | |
| 8284 | fusionAlg_B.BusCreator1_fl.statusMisAlign = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 8285 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8286 | |
| 8287 | /* End of DataTypeConversion: '<S209>/Data Type Conversion3' */ |
| 8288 | |
| 8289 | /* DataTypeConversion: '<S209>/Data Type Conversion4' */ |
| 8290 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x80_Sta_lz); |
| 8291 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8292 | tmp = 0.0F; |
| 8293 | } else { |
| 8294 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8295 | } |
| 8296 | |
| 8297 | fusionAlg_B.BusCreator1_fl.sGUFail = (uint8_T)(tmp < 0.0F ? (int32_T)(uint8_T) |
| 8298 | -(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8299 | |
| 8300 | /* End of DataTypeConversion: '<S209>/Data Type Conversion4' */ |
| 8301 | |
| 8302 | /* DataTypeConversion: '<S209>/Data Type Conversion5' */ |
| 8303 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x80_Stat_n); |
| 8304 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8305 | tmp = 0.0F; |
| 8306 | } else { |
| 8307 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8308 | } |
| 8309 | |
| 8310 | fusionAlg_B.BusCreator1_fl.measEnabled = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 8311 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8312 | |
| 8313 | /* End of DataTypeConversion: '<S209>/Data Type Conversion5' */ |
| 8314 | |
| 8315 | /* DataTypeConversion: '<S209>/Data Type Conversion6' */ |
| 8316 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x80_Stat_p); |
| 8317 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8318 | tmp = 0.0F; |
| 8319 | } else { |
| 8320 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8321 | } |
| 8322 | |
| 8323 | fusionAlg_B.BusCreator1_fl.msgAliveCounter = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 8324 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8325 | |
| 8326 | /* End of DataTypeConversion: '<S209>/Data Type Conversion6' */ |
| 8327 | |
| 8328 | /* DataTypeConversion: '<S209>/Data Type Conversion7' */ |
| 8329 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x80_Stat_b); |
| 8330 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8331 | tmp = 0.0F; |
| 8332 | } else { |
| 8333 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8334 | } |
| 8335 | |
| 8336 | fusionAlg_B.BusCreator1_fl.latency = (uint8_T)(tmp < 0.0F ? (int32_T)(uint8_T) |
| 8337 | -(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8338 | |
| 8339 | /* End of DataTypeConversion: '<S209>/Data Type Conversion7' */ |
| 8340 | |
| 8341 | /* DataTypeConversion: '<S209>/Data Type Conversion8' */ |
| 8342 | tmp = (real32_T)floor(*rtu_Radar410_Info_st_x80_Status); |
| 8343 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8344 | tmp = 0.0F; |
| 8345 | } else { |
| 8346 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8347 | } |
| 8348 | |
| 8349 | fusionAlg_B.BusCreator1_fl.msgCheckSum = (uint8_T)(tmp < 0.0F ? (int32_T) |
| 8350 | (uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 8351 | |
| 8352 | /* End of DataTypeConversion: '<S209>/Data Type Conversion8' */ |
| 8353 | |
| 8354 | /* BusCreator: '<S209>/Bus Creator2' incorporates: |
| 8355 | * Constant: '<S209>/Constant' |
| 8356 | * Constant: '<S209>/Constant1' |
| 8357 | */ |
| 8358 | fusionAlg_B.BusCreator1_fl.reservedField.reserved1 = |
| 8359 | fusionAlg_P_g.Constant_Value_e1; |
| 8360 | fusionAlg_B.BusCreator1_fl.reservedField.reserved0 = |
| 8361 | fusionAlg_P_g.Constant1_Value_eix; |
| 8362 | |
| 8363 | /* BusCreator: '<S209>/Bus Creator1' */ |
| 8364 | fusionAlg_B.BusCreator1_fl.hostYaw = *rtu_Radar410_Info_st_x80_Stat_i; |
| 8365 | fusionAlg_B.BusCreator1_fl.hostSpeed = *rtu_Radar410_Info_st_x80_Stat_o; |
| 8366 | |
| 8367 | /* BusCreator: '<S7>/Bus Creator1' incorporates: |
| 8368 | * Constant: '<S7>/Constant' |
| 8369 | * Constant: '<S7>/Constant1' |
| 8370 | */ |
| 8371 | fusionAlg_B.reserved.reserved0 = fusionAlg_P_g.Constant_Value_ex; |
| 8372 | fusionAlg_B.reserved.reserved1 = fusionAlg_P_g.Constant1_Value; |
| 8373 | |
| 8374 | /* BusCreator: '<S7>/Bus Creator' incorporates: |
| 8375 | * Constant: '<S7>/count' |
| 8376 | * Constant: '<S7>/errType' |
| 8377 | * Constant: '<S7>/frameNum' |
| 8378 | * Constant: '<S7>/timestamp' |
| 8379 | */ |
| 8380 | fusionAlg_B.BusCreator_l.timestamp = fusionAlg_P_g.timestamp_Value; |
| 8381 | fusionAlg_B.BusCreator_l.frameNum = fusionAlg_P_g.frameNum_Value; |
| 8382 | fusionAlg_B.BusCreator_l.count = fusionAlg_P_g.count_Value; |
| 8383 | fusionAlg_B.BusCreator_l.errType = fusionAlg_P_g.errType_Value; |
| 8384 | fusionAlg_B.BusCreator_l.radarObj = fusionAlg_B.radarObj; |
| 8385 | fusionAlg_B.BusCreator_l.radarState = fusionAlg_B.BusCreator1_fl; |
| 8386 | fusionAlg_B.BusCreator_l.reserved = fusionAlg_B.reserved; |
| 8387 | |
| 8388 | /* DataTypeConversion: '<S9>/Data Type Conversion1' */ |
| 8389 | tmp = (real32_T)floor(rtu_Radar308_Info_st->LeftFrontRadar_Status.Version); |
| 8390 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8391 | tmp = 0.0F; |
| 8392 | } else { |
| 8393 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 8394 | } |
| 8395 | |
| 8396 | fusionAlg_B.BusCreator_i.frameNum = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 8397 | -tmp : (uint32_T)tmp; |
| 8398 | |
| 8399 | /* End of DataTypeConversion: '<S9>/Data Type Conversion1' */ |
| 8400 | |
| 8401 | /* DataTypeConversion: '<S9>/Data Type Conversion' */ |
| 8402 | tmp = (real32_T)floor(rtu_Radar308_Info_st->LeftFrontRadar_Status.ObjNum); |
| 8403 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8404 | tmp = 0.0F; |
| 8405 | } else { |
| 8406 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 8407 | } |
| 8408 | |
| 8409 | fusionAlg_B.BusCreator_i.count = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 8410 | -tmp : (uint32_T)tmp; |
| 8411 | |
| 8412 | /* End of DataTypeConversion: '<S9>/Data Type Conversion' */ |
| 8413 | |
| 8414 | /* Selector: '<S13>/Selector' incorporates: |
| 8415 | * Constant: '<S13>/Constant' |
| 8416 | */ |
| 8417 | fusionAlg_B.Selector_n = rtu_Radar308_Info_st-> |
| 8418 | leftFrontRadar_General[fusionAlg_P_g.Constant_Value_jl]; |
| 8419 | |
| 8420 | /* DataTypeConversion: '<S15>/Data Type Conversion' */ |
| 8421 | tmp = (real32_T)floor(fusionAlg_B.Selector_n.ID); |
| 8422 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8423 | tmp = 0.0F; |
| 8424 | } else { |
| 8425 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8426 | } |
| 8427 | |
| 8428 | fusionAlg_B.DataTypeConversion_nj = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 8429 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8430 | |
| 8431 | /* End of DataTypeConversion: '<S15>/Data Type Conversion' */ |
| 8432 | |
| 8433 | /* Switch: '<S15>/Switch' incorporates: |
| 8434 | * Constant: '<S15>/Constant7' |
| 8435 | * Constant: '<S15>/Constant8' |
| 8436 | */ |
| 8437 | if (fusionAlg_B.DataTypeConversion_nj > fusionAlg_P_g.Switch_Threshold) { |
| 8438 | fusionAlg_B.Switch = fusionAlg_P_g.Constant7_Value_k; |
| 8439 | } else { |
| 8440 | fusionAlg_B.Switch = fusionAlg_P_g.Constant8_Value_m; |
| 8441 | } |
| 8442 | |
| 8443 | /* End of Switch: '<S15>/Switch' */ |
| 8444 | |
| 8445 | /* DataTypeConversion: '<S15>/Data Type Conversion1' */ |
| 8446 | tmp = (real32_T)floor(fusionAlg_B.Selector_n.DynProp); |
| 8447 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8448 | tmp = 0.0F; |
| 8449 | } else { |
| 8450 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8451 | } |
| 8452 | |
| 8453 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objMotionPattern = (uint8_T) |
| 8454 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 8455 | tmp); |
| 8456 | |
| 8457 | /* End of DataTypeConversion: '<S15>/Data Type Conversion1' */ |
| 8458 | |
| 8459 | /* BusCreator: '<S15>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 8460 | * Constant: '<S15>/Constant' |
| 8461 | * Constant: '<S15>/Constant1' |
| 8462 | */ |
| 8463 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.reserved.reserved1 = |
| 8464 | fusionAlg_P_g.Constant_Value_lt; |
| 8465 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.reserved.reserved0 = |
| 8466 | fusionAlg_P_g.Constant1_Value_jj; |
| 8467 | |
| 8468 | /* BusCreator: '<S15>/Bus Creator1' incorporates: |
| 8469 | * Constant: '<S15>/Constant10' |
| 8470 | * Constant: '<S15>/Constant2' |
| 8471 | * Constant: '<S15>/Constant3' |
| 8472 | * Constant: '<S15>/Constant4' |
| 8473 | * Constant: '<S15>/Constant5' |
| 8474 | * Constant: '<S15>/Constant6' |
| 8475 | * Constant: '<S15>/Constant9' |
| 8476 | */ |
| 8477 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objObstacleProb = |
| 8478 | fusionAlg_B.Selector_n.RCS; |
| 8479 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objXPos_Stdev = |
| 8480 | fusionAlg_P_g.Constant2_Value; |
| 8481 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objYPos_Stdev = |
| 8482 | fusionAlg_P_g.Constant3_Value; |
| 8483 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objXVelRel_Stdev = |
| 8484 | fusionAlg_P_g.Constant4_Value; |
| 8485 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objXAccRel = |
| 8486 | fusionAlg_P_g.Constant5_Value; |
| 8487 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objExstProb = |
| 8488 | fusionAlg_P_g.Constant6_Value; |
| 8489 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objYVelRel = |
| 8490 | fusionAlg_B.Selector_n.VrelLat; |
| 8491 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objXVelRel = |
| 8492 | fusionAlg_B.Selector_n.VrelLong; |
| 8493 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objXPos = |
| 8494 | fusionAlg_B.Selector_n.DistLong; |
| 8495 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objYPos = |
| 8496 | fusionAlg_B.Selector_n.DistLat; |
| 8497 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objID = |
| 8498 | fusionAlg_B.DataTypeConversion_nj; |
| 8499 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objUpdateFlag = |
| 8500 | fusionAlg_B.Switch; |
| 8501 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objValidFlag = |
| 8502 | fusionAlg_B.Switch; |
| 8503 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objType = |
| 8504 | fusionAlg_P_g.Constant9_Value_p; |
| 8505 | fusionAlg_B.BusCreator_i.radarObj.radar_01_obj.objMeasFlag = |
| 8506 | fusionAlg_P_g.Constant10_Value_l; |
| 8507 | |
| 8508 | /* Selector: '<S13>/Selector1' incorporates: |
| 8509 | * Constant: '<S13>/Constant1' |
| 8510 | */ |
| 8511 | fusionAlg_B.Selector1_d = rtu_Radar308_Info_st-> |
| 8512 | leftFrontRadar_General[fusionAlg_P_g.Constant1_Value_cam]; |
| 8513 | |
| 8514 | /* DataTypeConversion: '<S26>/Data Type Conversion' */ |
| 8515 | tmp = (real32_T)floor(fusionAlg_B.Selector1_d.ID); |
| 8516 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8517 | tmp = 0.0F; |
| 8518 | } else { |
| 8519 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8520 | } |
| 8521 | |
| 8522 | fusionAlg_B.DataTypeConversion_om = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 8523 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8524 | |
| 8525 | /* End of DataTypeConversion: '<S26>/Data Type Conversion' */ |
| 8526 | |
| 8527 | /* Switch: '<S26>/Switch' incorporates: |
| 8528 | * Constant: '<S26>/Constant7' |
| 8529 | * Constant: '<S26>/Constant8' |
| 8530 | */ |
| 8531 | if (fusionAlg_B.DataTypeConversion_om > fusionAlg_P_g.Switch_Threshold_m) { |
| 8532 | fusionAlg_B.Switch_a = fusionAlg_P_g.Constant7_Value_d; |
| 8533 | } else { |
| 8534 | fusionAlg_B.Switch_a = fusionAlg_P_g.Constant8_Value_f; |
| 8535 | } |
| 8536 | |
| 8537 | /* End of Switch: '<S26>/Switch' */ |
| 8538 | |
| 8539 | /* DataTypeConversion: '<S26>/Data Type Conversion1' */ |
| 8540 | tmp = (real32_T)floor(fusionAlg_B.Selector1_d.DynProp); |
| 8541 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8542 | tmp = 0.0F; |
| 8543 | } else { |
| 8544 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8545 | } |
| 8546 | |
| 8547 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objMotionPattern = (uint8_T) |
| 8548 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 8549 | tmp); |
| 8550 | |
| 8551 | /* End of DataTypeConversion: '<S26>/Data Type Conversion1' */ |
| 8552 | |
| 8553 | /* BusCreator: '<S26>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 8554 | * Constant: '<S26>/Constant' |
| 8555 | * Constant: '<S26>/Constant1' |
| 8556 | */ |
| 8557 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.reserved.reserved1 = |
| 8558 | fusionAlg_P_g.Constant_Value_h1; |
| 8559 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.reserved.reserved0 = |
| 8560 | fusionAlg_P_g.Constant1_Value_d0; |
| 8561 | |
| 8562 | /* BusCreator: '<S26>/Bus Creator1' incorporates: |
| 8563 | * Constant: '<S26>/Constant10' |
| 8564 | * Constant: '<S26>/Constant2' |
| 8565 | * Constant: '<S26>/Constant3' |
| 8566 | * Constant: '<S26>/Constant4' |
| 8567 | * Constant: '<S26>/Constant5' |
| 8568 | * Constant: '<S26>/Constant6' |
| 8569 | * Constant: '<S26>/Constant9' |
| 8570 | */ |
| 8571 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objObstacleProb = |
| 8572 | fusionAlg_B.Selector1_d.RCS; |
| 8573 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objXPos_Stdev = |
| 8574 | fusionAlg_P_g.Constant2_Value_j; |
| 8575 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objYPos_Stdev = |
| 8576 | fusionAlg_P_g.Constant3_Value_m; |
| 8577 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objXVelRel_Stdev = |
| 8578 | fusionAlg_P_g.Constant4_Value_b; |
| 8579 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objXAccRel = |
| 8580 | fusionAlg_P_g.Constant5_Value_o; |
| 8581 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objExstProb = |
| 8582 | fusionAlg_P_g.Constant6_Value_k; |
| 8583 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objYVelRel = |
| 8584 | fusionAlg_B.Selector1_d.VrelLat; |
| 8585 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objXVelRel = |
| 8586 | fusionAlg_B.Selector1_d.VrelLong; |
| 8587 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objXPos = |
| 8588 | fusionAlg_B.Selector1_d.DistLong; |
| 8589 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objYPos = |
| 8590 | fusionAlg_B.Selector1_d.DistLat; |
| 8591 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objID = |
| 8592 | fusionAlg_B.DataTypeConversion_om; |
| 8593 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objUpdateFlag = |
| 8594 | fusionAlg_B.Switch_a; |
| 8595 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objValidFlag = |
| 8596 | fusionAlg_B.Switch_a; |
| 8597 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objType = |
| 8598 | fusionAlg_P_g.Constant9_Value_g; |
| 8599 | fusionAlg_B.BusCreator_i.radarObj.radar_02_obj.objMeasFlag = |
| 8600 | fusionAlg_P_g.Constant10_Value_b; |
| 8601 | |
| 8602 | /* Selector: '<S13>/Selector2' incorporates: |
| 8603 | * Constant: '<S13>/Constant2' |
| 8604 | */ |
| 8605 | fusionAlg_B.Selector2_h = rtu_Radar308_Info_st-> |
| 8606 | leftFrontRadar_General[fusionAlg_P_g.Constant2_Value_jv]; |
| 8607 | |
| 8608 | /* DataTypeConversion: '<S37>/Data Type Conversion' */ |
| 8609 | tmp = (real32_T)floor(fusionAlg_B.Selector2_h.ID); |
| 8610 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8611 | tmp = 0.0F; |
| 8612 | } else { |
| 8613 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8614 | } |
| 8615 | |
| 8616 | fusionAlg_B.DataTypeConversion_bh = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 8617 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8618 | |
| 8619 | /* End of DataTypeConversion: '<S37>/Data Type Conversion' */ |
| 8620 | |
| 8621 | /* Switch: '<S37>/Switch' incorporates: |
| 8622 | * Constant: '<S37>/Constant7' |
| 8623 | * Constant: '<S37>/Constant8' |
| 8624 | */ |
| 8625 | if (fusionAlg_B.DataTypeConversion_bh > fusionAlg_P_g.Switch_Threshold_g) { |
| 8626 | fusionAlg_B.Switch_c = fusionAlg_P_g.Constant7_Value_k2; |
| 8627 | } else { |
| 8628 | fusionAlg_B.Switch_c = fusionAlg_P_g.Constant8_Value_m3; |
| 8629 | } |
| 8630 | |
| 8631 | /* End of Switch: '<S37>/Switch' */ |
| 8632 | |
| 8633 | /* DataTypeConversion: '<S37>/Data Type Conversion1' */ |
| 8634 | tmp = (real32_T)floor(fusionAlg_B.Selector2_h.DynProp); |
| 8635 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8636 | tmp = 0.0F; |
| 8637 | } else { |
| 8638 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8639 | } |
| 8640 | |
| 8641 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objMotionPattern = (uint8_T) |
| 8642 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 8643 | tmp); |
| 8644 | |
| 8645 | /* End of DataTypeConversion: '<S37>/Data Type Conversion1' */ |
| 8646 | |
| 8647 | /* BusCreator: '<S37>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 8648 | * Constant: '<S37>/Constant' |
| 8649 | * Constant: '<S37>/Constant1' |
| 8650 | */ |
| 8651 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.reserved.reserved1 = |
| 8652 | fusionAlg_P_g.Constant_Value_n2; |
| 8653 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.reserved.reserved0 = |
| 8654 | fusionAlg_P_g.Constant1_Value_lw; |
| 8655 | |
| 8656 | /* BusCreator: '<S37>/Bus Creator1' incorporates: |
| 8657 | * Constant: '<S37>/Constant10' |
| 8658 | * Constant: '<S37>/Constant2' |
| 8659 | * Constant: '<S37>/Constant3' |
| 8660 | * Constant: '<S37>/Constant4' |
| 8661 | * Constant: '<S37>/Constant5' |
| 8662 | * Constant: '<S37>/Constant6' |
| 8663 | * Constant: '<S37>/Constant9' |
| 8664 | */ |
| 8665 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objObstacleProb = |
| 8666 | fusionAlg_B.Selector2_h.RCS; |
| 8667 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objXPos_Stdev = |
| 8668 | fusionAlg_P_g.Constant2_Value_l; |
| 8669 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objYPos_Stdev = |
| 8670 | fusionAlg_P_g.Constant3_Value_j; |
| 8671 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objXVelRel_Stdev = |
| 8672 | fusionAlg_P_g.Constant4_Value_c; |
| 8673 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objXAccRel = |
| 8674 | fusionAlg_P_g.Constant5_Value_e; |
| 8675 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objExstProb = |
| 8676 | fusionAlg_P_g.Constant6_Value_b; |
| 8677 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objYVelRel = |
| 8678 | fusionAlg_B.Selector2_h.VrelLat; |
| 8679 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objXVelRel = |
| 8680 | fusionAlg_B.Selector2_h.VrelLong; |
| 8681 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objXPos = |
| 8682 | fusionAlg_B.Selector2_h.DistLong; |
| 8683 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objYPos = |
| 8684 | fusionAlg_B.Selector2_h.DistLat; |
| 8685 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objID = |
| 8686 | fusionAlg_B.DataTypeConversion_bh; |
| 8687 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objUpdateFlag = |
| 8688 | fusionAlg_B.Switch_c; |
| 8689 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objValidFlag = |
| 8690 | fusionAlg_B.Switch_c; |
| 8691 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objType = |
| 8692 | fusionAlg_P_g.Constant9_Value_o; |
| 8693 | fusionAlg_B.BusCreator_i.radarObj.radar_03_obj.objMeasFlag = |
| 8694 | fusionAlg_P_g.Constant10_Value_o; |
| 8695 | |
| 8696 | /* Selector: '<S13>/Selector3' incorporates: |
| 8697 | * Constant: '<S13>/Constant3' |
| 8698 | */ |
| 8699 | fusionAlg_B.Selector3_p = rtu_Radar308_Info_st-> |
| 8700 | leftFrontRadar_General[fusionAlg_P_g.Constant3_Value_gv]; |
| 8701 | |
| 8702 | /* DataTypeConversion: '<S48>/Data Type Conversion' */ |
| 8703 | tmp = (real32_T)floor(fusionAlg_B.Selector3_p.ID); |
| 8704 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8705 | tmp = 0.0F; |
| 8706 | } else { |
| 8707 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8708 | } |
| 8709 | |
| 8710 | fusionAlg_B.DataTypeConversion_hf = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 8711 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8712 | |
| 8713 | /* End of DataTypeConversion: '<S48>/Data Type Conversion' */ |
| 8714 | |
| 8715 | /* Switch: '<S48>/Switch' incorporates: |
| 8716 | * Constant: '<S48>/Constant7' |
| 8717 | * Constant: '<S48>/Constant8' |
| 8718 | */ |
| 8719 | if (fusionAlg_B.DataTypeConversion_hf > fusionAlg_P_g.Switch_Threshold_p) { |
| 8720 | fusionAlg_B.Switch_az = fusionAlg_P_g.Constant7_Value_h; |
| 8721 | } else { |
| 8722 | fusionAlg_B.Switch_az = fusionAlg_P_g.Constant8_Value_b; |
| 8723 | } |
| 8724 | |
| 8725 | /* End of Switch: '<S48>/Switch' */ |
| 8726 | |
| 8727 | /* DataTypeConversion: '<S48>/Data Type Conversion1' */ |
| 8728 | tmp = (real32_T)floor(fusionAlg_B.Selector3_p.DynProp); |
| 8729 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8730 | tmp = 0.0F; |
| 8731 | } else { |
| 8732 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8733 | } |
| 8734 | |
| 8735 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objMotionPattern = (uint8_T) |
| 8736 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 8737 | tmp); |
| 8738 | |
| 8739 | /* End of DataTypeConversion: '<S48>/Data Type Conversion1' */ |
| 8740 | |
| 8741 | /* BusCreator: '<S48>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 8742 | * Constant: '<S48>/Constant' |
| 8743 | * Constant: '<S48>/Constant1' |
| 8744 | */ |
| 8745 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.reserved.reserved1 = |
| 8746 | fusionAlg_P_g.Constant_Value_dn; |
| 8747 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.reserved.reserved0 = |
| 8748 | fusionAlg_P_g.Constant1_Value_nz; |
| 8749 | |
| 8750 | /* BusCreator: '<S48>/Bus Creator1' incorporates: |
| 8751 | * Constant: '<S48>/Constant10' |
| 8752 | * Constant: '<S48>/Constant2' |
| 8753 | * Constant: '<S48>/Constant3' |
| 8754 | * Constant: '<S48>/Constant4' |
| 8755 | * Constant: '<S48>/Constant5' |
| 8756 | * Constant: '<S48>/Constant6' |
| 8757 | * Constant: '<S48>/Constant9' |
| 8758 | */ |
| 8759 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objObstacleProb = |
| 8760 | fusionAlg_B.Selector3_p.RCS; |
| 8761 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objXPos_Stdev = |
| 8762 | fusionAlg_P_g.Constant2_Value_p; |
| 8763 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objYPos_Stdev = |
| 8764 | fusionAlg_P_g.Constant3_Value_f; |
| 8765 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objXVelRel_Stdev = |
| 8766 | fusionAlg_P_g.Constant4_Value_p; |
| 8767 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objXAccRel = |
| 8768 | fusionAlg_P_g.Constant5_Value_a; |
| 8769 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objExstProb = |
| 8770 | fusionAlg_P_g.Constant6_Value_g; |
| 8771 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objYVelRel = |
| 8772 | fusionAlg_B.Selector3_p.VrelLat; |
| 8773 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objXVelRel = |
| 8774 | fusionAlg_B.Selector3_p.VrelLong; |
| 8775 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objXPos = |
| 8776 | fusionAlg_B.Selector3_p.DistLong; |
| 8777 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objYPos = |
| 8778 | fusionAlg_B.Selector3_p.DistLat; |
| 8779 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objID = |
| 8780 | fusionAlg_B.DataTypeConversion_hf; |
| 8781 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objUpdateFlag = |
| 8782 | fusionAlg_B.Switch_az; |
| 8783 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objValidFlag = |
| 8784 | fusionAlg_B.Switch_az; |
| 8785 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objType = |
| 8786 | fusionAlg_P_g.Constant9_Value_a; |
| 8787 | fusionAlg_B.BusCreator_i.radarObj.radar_04_obj.objMeasFlag = |
| 8788 | fusionAlg_P_g.Constant10_Value_d; |
| 8789 | |
| 8790 | /* Selector: '<S13>/Selector4' incorporates: |
| 8791 | * Constant: '<S13>/Constant4' |
| 8792 | */ |
| 8793 | fusionAlg_B.Selector4_m = rtu_Radar308_Info_st-> |
| 8794 | leftFrontRadar_General[fusionAlg_P_g.Constant4_Value_j0]; |
| 8795 | |
| 8796 | /* DataTypeConversion: '<S50>/Data Type Conversion' */ |
| 8797 | tmp = (real32_T)floor(fusionAlg_B.Selector4_m.ID); |
| 8798 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8799 | tmp = 0.0F; |
| 8800 | } else { |
| 8801 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8802 | } |
| 8803 | |
| 8804 | fusionAlg_B.DataTypeConversion_lv = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 8805 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8806 | |
| 8807 | /* End of DataTypeConversion: '<S50>/Data Type Conversion' */ |
| 8808 | |
| 8809 | /* Switch: '<S50>/Switch' incorporates: |
| 8810 | * Constant: '<S50>/Constant7' |
| 8811 | * Constant: '<S50>/Constant8' |
| 8812 | */ |
| 8813 | if (fusionAlg_B.DataTypeConversion_lv > fusionAlg_P_g.Switch_Threshold_c) { |
| 8814 | fusionAlg_B.Switch_k = fusionAlg_P_g.Constant7_Value_l; |
| 8815 | } else { |
| 8816 | fusionAlg_B.Switch_k = fusionAlg_P_g.Constant8_Value_fq; |
| 8817 | } |
| 8818 | |
| 8819 | /* End of Switch: '<S50>/Switch' */ |
| 8820 | |
| 8821 | /* DataTypeConversion: '<S50>/Data Type Conversion1' */ |
| 8822 | tmp = (real32_T)floor(fusionAlg_B.Selector4_m.DynProp); |
| 8823 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8824 | tmp = 0.0F; |
| 8825 | } else { |
| 8826 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8827 | } |
| 8828 | |
| 8829 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objMotionPattern = (uint8_T) |
| 8830 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 8831 | tmp); |
| 8832 | |
| 8833 | /* End of DataTypeConversion: '<S50>/Data Type Conversion1' */ |
| 8834 | |
| 8835 | /* BusCreator: '<S50>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 8836 | * Constant: '<S50>/Constant' |
| 8837 | * Constant: '<S50>/Constant1' |
| 8838 | */ |
| 8839 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.reserved.reserved1 = |
| 8840 | fusionAlg_P_g.Constant_Value_aqr; |
| 8841 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.reserved.reserved0 = |
| 8842 | fusionAlg_P_g.Constant1_Value_ls; |
| 8843 | |
| 8844 | /* BusCreator: '<S50>/Bus Creator1' incorporates: |
| 8845 | * Constant: '<S50>/Constant10' |
| 8846 | * Constant: '<S50>/Constant2' |
| 8847 | * Constant: '<S50>/Constant3' |
| 8848 | * Constant: '<S50>/Constant4' |
| 8849 | * Constant: '<S50>/Constant5' |
| 8850 | * Constant: '<S50>/Constant6' |
| 8851 | * Constant: '<S50>/Constant9' |
| 8852 | */ |
| 8853 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objObstacleProb = |
| 8854 | fusionAlg_B.Selector4_m.RCS; |
| 8855 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objXPos_Stdev = |
| 8856 | fusionAlg_P_g.Constant2_Value_i; |
| 8857 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objYPos_Stdev = |
| 8858 | fusionAlg_P_g.Constant3_Value_p; |
| 8859 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objXVelRel_Stdev = |
| 8860 | fusionAlg_P_g.Constant4_Value_a; |
| 8861 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objXAccRel = |
| 8862 | fusionAlg_P_g.Constant5_Value_g; |
| 8863 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objExstProb = |
| 8864 | fusionAlg_P_g.Constant6_Value_p; |
| 8865 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objYVelRel = |
| 8866 | fusionAlg_B.Selector4_m.VrelLat; |
| 8867 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objXVelRel = |
| 8868 | fusionAlg_B.Selector4_m.VrelLong; |
| 8869 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objXPos = |
| 8870 | fusionAlg_B.Selector4_m.DistLong; |
| 8871 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objYPos = |
| 8872 | fusionAlg_B.Selector4_m.DistLat; |
| 8873 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objID = |
| 8874 | fusionAlg_B.DataTypeConversion_lv; |
| 8875 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objUpdateFlag = |
| 8876 | fusionAlg_B.Switch_k; |
| 8877 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objValidFlag = |
| 8878 | fusionAlg_B.Switch_k; |
| 8879 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objType = |
| 8880 | fusionAlg_P_g.Constant9_Value_pp; |
| 8881 | fusionAlg_B.BusCreator_i.radarObj.radar_05_obj.objMeasFlag = |
| 8882 | fusionAlg_P_g.Constant10_Value_i; |
| 8883 | |
| 8884 | /* Selector: '<S13>/Selector5' incorporates: |
| 8885 | * Constant: '<S13>/Constant5' |
| 8886 | */ |
| 8887 | fusionAlg_B.Selector5_n = rtu_Radar308_Info_st-> |
| 8888 | leftFrontRadar_General[fusionAlg_P_g.Constant5_Value_olh]; |
| 8889 | |
| 8890 | /* DataTypeConversion: '<S51>/Data Type Conversion' */ |
| 8891 | tmp = (real32_T)floor(fusionAlg_B.Selector5_n.ID); |
| 8892 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8893 | tmp = 0.0F; |
| 8894 | } else { |
| 8895 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8896 | } |
| 8897 | |
| 8898 | fusionAlg_B.DataTypeConversion_n4 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 8899 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8900 | |
| 8901 | /* End of DataTypeConversion: '<S51>/Data Type Conversion' */ |
| 8902 | |
| 8903 | /* Switch: '<S51>/Switch' incorporates: |
| 8904 | * Constant: '<S51>/Constant7' |
| 8905 | * Constant: '<S51>/Constant8' |
| 8906 | */ |
| 8907 | if (fusionAlg_B.DataTypeConversion_n4 > fusionAlg_P_g.Switch_Threshold_cl) { |
| 8908 | fusionAlg_B.Switch_p = fusionAlg_P_g.Constant7_Value_b; |
| 8909 | } else { |
| 8910 | fusionAlg_B.Switch_p = fusionAlg_P_g.Constant8_Value_bc; |
| 8911 | } |
| 8912 | |
| 8913 | /* End of Switch: '<S51>/Switch' */ |
| 8914 | |
| 8915 | /* DataTypeConversion: '<S51>/Data Type Conversion1' */ |
| 8916 | tmp = (real32_T)floor(fusionAlg_B.Selector5_n.DynProp); |
| 8917 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8918 | tmp = 0.0F; |
| 8919 | } else { |
| 8920 | tmp = (real32_T)fmod(tmp, 256.0); |
| 8921 | } |
| 8922 | |
| 8923 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objMotionPattern = (uint8_T) |
| 8924 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 8925 | tmp); |
| 8926 | |
| 8927 | /* End of DataTypeConversion: '<S51>/Data Type Conversion1' */ |
| 8928 | |
| 8929 | /* BusCreator: '<S51>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 8930 | * Constant: '<S51>/Constant' |
| 8931 | * Constant: '<S51>/Constant1' |
| 8932 | */ |
| 8933 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.reserved.reserved1 = |
| 8934 | fusionAlg_P_g.Constant_Value_hs; |
| 8935 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.reserved.reserved0 = |
| 8936 | fusionAlg_P_g.Constant1_Value_j1; |
| 8937 | |
| 8938 | /* BusCreator: '<S51>/Bus Creator1' incorporates: |
| 8939 | * Constant: '<S51>/Constant10' |
| 8940 | * Constant: '<S51>/Constant2' |
| 8941 | * Constant: '<S51>/Constant3' |
| 8942 | * Constant: '<S51>/Constant4' |
| 8943 | * Constant: '<S51>/Constant5' |
| 8944 | * Constant: '<S51>/Constant6' |
| 8945 | * Constant: '<S51>/Constant9' |
| 8946 | */ |
| 8947 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objObstacleProb = |
| 8948 | fusionAlg_B.Selector5_n.RCS; |
| 8949 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objXPos_Stdev = |
| 8950 | fusionAlg_P_g.Constant2_Value_m; |
| 8951 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objYPos_Stdev = |
| 8952 | fusionAlg_P_g.Constant3_Value_a; |
| 8953 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objXVelRel_Stdev = |
| 8954 | fusionAlg_P_g.Constant4_Value_g; |
| 8955 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objXAccRel = |
| 8956 | fusionAlg_P_g.Constant5_Value_e1; |
| 8957 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objExstProb = |
| 8958 | fusionAlg_P_g.Constant6_Value_c; |
| 8959 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objYVelRel = |
| 8960 | fusionAlg_B.Selector5_n.VrelLat; |
| 8961 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objXVelRel = |
| 8962 | fusionAlg_B.Selector5_n.VrelLong; |
| 8963 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objXPos = |
| 8964 | fusionAlg_B.Selector5_n.DistLong; |
| 8965 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objYPos = |
| 8966 | fusionAlg_B.Selector5_n.DistLat; |
| 8967 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objID = |
| 8968 | fusionAlg_B.DataTypeConversion_n4; |
| 8969 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objUpdateFlag = |
| 8970 | fusionAlg_B.Switch_p; |
| 8971 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objValidFlag = |
| 8972 | fusionAlg_B.Switch_p; |
| 8973 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objType = |
| 8974 | fusionAlg_P_g.Constant9_Value_b; |
| 8975 | fusionAlg_B.BusCreator_i.radarObj.radar_06_obj.objMeasFlag = |
| 8976 | fusionAlg_P_g.Constant10_Value_e; |
| 8977 | |
| 8978 | /* Selector: '<S13>/Selector6' incorporates: |
| 8979 | * Constant: '<S13>/Constant6' |
| 8980 | */ |
| 8981 | fusionAlg_B.Selector6_l = rtu_Radar308_Info_st-> |
| 8982 | leftFrontRadar_General[fusionAlg_P_g.Constant6_Value_mv]; |
| 8983 | |
| 8984 | /* DataTypeConversion: '<S52>/Data Type Conversion' */ |
| 8985 | tmp = (real32_T)floor(fusionAlg_B.Selector6_l.ID); |
| 8986 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 8987 | tmp = 0.0F; |
| 8988 | } else { |
| 8989 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 8990 | } |
| 8991 | |
| 8992 | fusionAlg_B.DataTypeConversion_by5 = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 8993 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 8994 | |
| 8995 | /* End of DataTypeConversion: '<S52>/Data Type Conversion' */ |
| 8996 | |
| 8997 | /* Switch: '<S52>/Switch' incorporates: |
| 8998 | * Constant: '<S52>/Constant7' |
| 8999 | * Constant: '<S52>/Constant8' |
| 9000 | */ |
| 9001 | if (fusionAlg_B.DataTypeConversion_by5 > fusionAlg_P_g.Switch_Threshold_a) { |
| 9002 | fusionAlg_B.Switch_pp = fusionAlg_P_g.Constant7_Value_j; |
| 9003 | } else { |
| 9004 | fusionAlg_B.Switch_pp = fusionAlg_P_g.Constant8_Value_o; |
| 9005 | } |
| 9006 | |
| 9007 | /* End of Switch: '<S52>/Switch' */ |
| 9008 | |
| 9009 | /* DataTypeConversion: '<S52>/Data Type Conversion1' */ |
| 9010 | tmp = (real32_T)floor(fusionAlg_B.Selector6_l.DynProp); |
| 9011 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9012 | tmp = 0.0F; |
| 9013 | } else { |
| 9014 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9015 | } |
| 9016 | |
| 9017 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objMotionPattern = (uint8_T) |
| 9018 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9019 | tmp); |
| 9020 | |
| 9021 | /* End of DataTypeConversion: '<S52>/Data Type Conversion1' */ |
| 9022 | |
| 9023 | /* BusCreator: '<S52>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9024 | * Constant: '<S52>/Constant' |
| 9025 | * Constant: '<S52>/Constant1' |
| 9026 | */ |
| 9027 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.reserved.reserved1 = |
| 9028 | fusionAlg_P_g.Constant_Value_pg; |
| 9029 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.reserved.reserved0 = |
| 9030 | fusionAlg_P_g.Constant1_Value_m1; |
| 9031 | |
| 9032 | /* BusCreator: '<S52>/Bus Creator1' incorporates: |
| 9033 | * Constant: '<S52>/Constant10' |
| 9034 | * Constant: '<S52>/Constant2' |
| 9035 | * Constant: '<S52>/Constant3' |
| 9036 | * Constant: '<S52>/Constant4' |
| 9037 | * Constant: '<S52>/Constant5' |
| 9038 | * Constant: '<S52>/Constant6' |
| 9039 | * Constant: '<S52>/Constant9' |
| 9040 | */ |
| 9041 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objObstacleProb = |
| 9042 | fusionAlg_B.Selector6_l.RCS; |
| 9043 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objXPos_Stdev = |
| 9044 | fusionAlg_P_g.Constant2_Value_k; |
| 9045 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objYPos_Stdev = |
| 9046 | fusionAlg_P_g.Constant3_Value_mo; |
| 9047 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objXVelRel_Stdev = |
| 9048 | fusionAlg_P_g.Constant4_Value_i; |
| 9049 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objXAccRel = |
| 9050 | fusionAlg_P_g.Constant5_Value_l; |
| 9051 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objExstProb = |
| 9052 | fusionAlg_P_g.Constant6_Value_l; |
| 9053 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objYVelRel = |
| 9054 | fusionAlg_B.Selector6_l.VrelLat; |
| 9055 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objXVelRel = |
| 9056 | fusionAlg_B.Selector6_l.VrelLong; |
| 9057 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objXPos = |
| 9058 | fusionAlg_B.Selector6_l.DistLong; |
| 9059 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objYPos = |
| 9060 | fusionAlg_B.Selector6_l.DistLat; |
| 9061 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objID = |
| 9062 | fusionAlg_B.DataTypeConversion_by5; |
| 9063 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objUpdateFlag = |
| 9064 | fusionAlg_B.Switch_pp; |
| 9065 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objValidFlag = |
| 9066 | fusionAlg_B.Switch_pp; |
| 9067 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objType = |
| 9068 | fusionAlg_P_g.Constant9_Value_f; |
| 9069 | fusionAlg_B.BusCreator_i.radarObj.radar_07_obj.objMeasFlag = |
| 9070 | fusionAlg_P_g.Constant10_Value_g; |
| 9071 | |
| 9072 | /* Selector: '<S13>/Selector7' incorporates: |
| 9073 | * Constant: '<S13>/Constant7' |
| 9074 | */ |
| 9075 | fusionAlg_B.Selector7_f = rtu_Radar308_Info_st-> |
| 9076 | leftFrontRadar_General[fusionAlg_P_g.Constant7_Value_m]; |
| 9077 | |
| 9078 | /* DataTypeConversion: '<S53>/Data Type Conversion' */ |
| 9079 | tmp = (real32_T)floor(fusionAlg_B.Selector7_f.ID); |
| 9080 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9081 | tmp = 0.0F; |
| 9082 | } else { |
| 9083 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9084 | } |
| 9085 | |
| 9086 | fusionAlg_B.DataTypeConversion_g4z = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 9087 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9088 | |
| 9089 | /* End of DataTypeConversion: '<S53>/Data Type Conversion' */ |
| 9090 | |
| 9091 | /* Switch: '<S53>/Switch' incorporates: |
| 9092 | * Constant: '<S53>/Constant7' |
| 9093 | * Constant: '<S53>/Constant8' |
| 9094 | */ |
| 9095 | if (fusionAlg_B.DataTypeConversion_g4z > fusionAlg_P_g.Switch_Threshold_mg) { |
| 9096 | fusionAlg_B.Switch_i = fusionAlg_P_g.Constant7_Value_dp; |
| 9097 | } else { |
| 9098 | fusionAlg_B.Switch_i = fusionAlg_P_g.Constant8_Value_c; |
| 9099 | } |
| 9100 | |
| 9101 | /* End of Switch: '<S53>/Switch' */ |
| 9102 | |
| 9103 | /* DataTypeConversion: '<S53>/Data Type Conversion1' */ |
| 9104 | tmp = (real32_T)floor(fusionAlg_B.Selector7_f.DynProp); |
| 9105 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9106 | tmp = 0.0F; |
| 9107 | } else { |
| 9108 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9109 | } |
| 9110 | |
| 9111 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objMotionPattern = (uint8_T) |
| 9112 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9113 | tmp); |
| 9114 | |
| 9115 | /* End of DataTypeConversion: '<S53>/Data Type Conversion1' */ |
| 9116 | |
| 9117 | /* BusCreator: '<S53>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9118 | * Constant: '<S53>/Constant' |
| 9119 | * Constant: '<S53>/Constant1' |
| 9120 | */ |
| 9121 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.reserved.reserved1 = |
| 9122 | fusionAlg_P_g.Constant_Value_cj; |
| 9123 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.reserved.reserved0 = |
| 9124 | fusionAlg_P_g.Constant1_Value_pv; |
| 9125 | |
| 9126 | /* BusCreator: '<S53>/Bus Creator1' incorporates: |
| 9127 | * Constant: '<S53>/Constant10' |
| 9128 | * Constant: '<S53>/Constant2' |
| 9129 | * Constant: '<S53>/Constant3' |
| 9130 | * Constant: '<S53>/Constant4' |
| 9131 | * Constant: '<S53>/Constant5' |
| 9132 | * Constant: '<S53>/Constant6' |
| 9133 | * Constant: '<S53>/Constant9' |
| 9134 | */ |
| 9135 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objObstacleProb = |
| 9136 | fusionAlg_B.Selector7_f.RCS; |
| 9137 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objXPos_Stdev = |
| 9138 | fusionAlg_P_g.Constant2_Value_f; |
| 9139 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objYPos_Stdev = |
| 9140 | fusionAlg_P_g.Constant3_Value_d; |
| 9141 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objXVelRel_Stdev = |
| 9142 | fusionAlg_P_g.Constant4_Value_d; |
| 9143 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objXAccRel = |
| 9144 | fusionAlg_P_g.Constant5_Value_eo; |
| 9145 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objExstProb = |
| 9146 | fusionAlg_P_g.Constant6_Value_h; |
| 9147 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objYVelRel = |
| 9148 | fusionAlg_B.Selector7_f.VrelLat; |
| 9149 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objXVelRel = |
| 9150 | fusionAlg_B.Selector7_f.VrelLong; |
| 9151 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objXPos = |
| 9152 | fusionAlg_B.Selector7_f.DistLong; |
| 9153 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objYPos = |
| 9154 | fusionAlg_B.Selector7_f.DistLat; |
| 9155 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objID = |
| 9156 | fusionAlg_B.DataTypeConversion_g4z; |
| 9157 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objUpdateFlag = |
| 9158 | fusionAlg_B.Switch_i; |
| 9159 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objValidFlag = |
| 9160 | fusionAlg_B.Switch_i; |
| 9161 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objType = |
| 9162 | fusionAlg_P_g.Constant9_Value_c; |
| 9163 | fusionAlg_B.BusCreator_i.radarObj.radar_08_obj.objMeasFlag = |
| 9164 | fusionAlg_P_g.Constant10_Value_m; |
| 9165 | |
| 9166 | /* Selector: '<S13>/Selector8' incorporates: |
| 9167 | * Constant: '<S13>/Constant8' |
| 9168 | */ |
| 9169 | fusionAlg_B.Selector8_e = rtu_Radar308_Info_st-> |
| 9170 | leftFrontRadar_General[fusionAlg_P_g.Constant8_Value_ci]; |
| 9171 | |
| 9172 | /* DataTypeConversion: '<S54>/Data Type Conversion' */ |
| 9173 | tmp = (real32_T)floor(fusionAlg_B.Selector8_e.ID); |
| 9174 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9175 | tmp = 0.0F; |
| 9176 | } else { |
| 9177 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9178 | } |
| 9179 | |
| 9180 | fusionAlg_B.DataTypeConversion_aa = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 9181 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9182 | |
| 9183 | /* End of DataTypeConversion: '<S54>/Data Type Conversion' */ |
| 9184 | |
| 9185 | /* Switch: '<S54>/Switch' incorporates: |
| 9186 | * Constant: '<S54>/Constant7' |
| 9187 | * Constant: '<S54>/Constant8' |
| 9188 | */ |
| 9189 | if (fusionAlg_B.DataTypeConversion_aa > fusionAlg_P_g.Switch_Threshold_d) { |
| 9190 | fusionAlg_B.Switch_ch = fusionAlg_P_g.Constant7_Value_f; |
| 9191 | } else { |
| 9192 | fusionAlg_B.Switch_ch = fusionAlg_P_g.Constant8_Value_d; |
| 9193 | } |
| 9194 | |
| 9195 | /* End of Switch: '<S54>/Switch' */ |
| 9196 | |
| 9197 | /* DataTypeConversion: '<S54>/Data Type Conversion1' */ |
| 9198 | tmp = (real32_T)floor(fusionAlg_B.Selector8_e.DynProp); |
| 9199 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9200 | tmp = 0.0F; |
| 9201 | } else { |
| 9202 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9203 | } |
| 9204 | |
| 9205 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objMotionPattern = (uint8_T) |
| 9206 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9207 | tmp); |
| 9208 | |
| 9209 | /* End of DataTypeConversion: '<S54>/Data Type Conversion1' */ |
| 9210 | |
| 9211 | /* BusCreator: '<S54>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9212 | * Constant: '<S54>/Constant' |
| 9213 | * Constant: '<S54>/Constant1' |
| 9214 | */ |
| 9215 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.reserved.reserved1 = |
| 9216 | fusionAlg_P_g.Constant_Value_bt; |
| 9217 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.reserved.reserved0 = |
| 9218 | fusionAlg_P_g.Constant1_Value_bm; |
| 9219 | |
| 9220 | /* BusCreator: '<S54>/Bus Creator1' incorporates: |
| 9221 | * Constant: '<S54>/Constant10' |
| 9222 | * Constant: '<S54>/Constant2' |
| 9223 | * Constant: '<S54>/Constant3' |
| 9224 | * Constant: '<S54>/Constant4' |
| 9225 | * Constant: '<S54>/Constant5' |
| 9226 | * Constant: '<S54>/Constant6' |
| 9227 | * Constant: '<S54>/Constant9' |
| 9228 | */ |
| 9229 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objObstacleProb = |
| 9230 | fusionAlg_B.Selector8_e.RCS; |
| 9231 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objXPos_Stdev = |
| 9232 | fusionAlg_P_g.Constant2_Value_d; |
| 9233 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objYPos_Stdev = |
| 9234 | fusionAlg_P_g.Constant3_Value_l; |
| 9235 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objXVelRel_Stdev = |
| 9236 | fusionAlg_P_g.Constant4_Value_pu; |
| 9237 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objXAccRel = |
| 9238 | fusionAlg_P_g.Constant5_Value_oz; |
| 9239 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objExstProb = |
| 9240 | fusionAlg_P_g.Constant6_Value_i; |
| 9241 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objYVelRel = |
| 9242 | fusionAlg_B.Selector8_e.VrelLat; |
| 9243 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objXVelRel = |
| 9244 | fusionAlg_B.Selector8_e.VrelLong; |
| 9245 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objXPos = |
| 9246 | fusionAlg_B.Selector8_e.DistLong; |
| 9247 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objYPos = |
| 9248 | fusionAlg_B.Selector8_e.DistLat; |
| 9249 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objID = |
| 9250 | fusionAlg_B.DataTypeConversion_aa; |
| 9251 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objUpdateFlag = |
| 9252 | fusionAlg_B.Switch_ch; |
| 9253 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objValidFlag = |
| 9254 | fusionAlg_B.Switch_ch; |
| 9255 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objType = |
| 9256 | fusionAlg_P_g.Constant9_Value_d; |
| 9257 | fusionAlg_B.BusCreator_i.radarObj.radar_09_obj.objMeasFlag = |
| 9258 | fusionAlg_P_g.Constant10_Value_a; |
| 9259 | |
| 9260 | /* Selector: '<S13>/Selector9' incorporates: |
| 9261 | * Constant: '<S13>/Constant9' |
| 9262 | */ |
| 9263 | fusionAlg_B.Selector9_j = rtu_Radar308_Info_st-> |
| 9264 | leftFrontRadar_General[fusionAlg_P_g.Constant9_Value_j]; |
| 9265 | |
| 9266 | /* DataTypeConversion: '<S16>/Data Type Conversion' */ |
| 9267 | tmp = (real32_T)floor(fusionAlg_B.Selector9_j.ID); |
| 9268 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9269 | tmp = 0.0F; |
| 9270 | } else { |
| 9271 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9272 | } |
| 9273 | |
| 9274 | fusionAlg_B.DataTypeConversion_cgy = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 9275 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9276 | |
| 9277 | /* End of DataTypeConversion: '<S16>/Data Type Conversion' */ |
| 9278 | |
| 9279 | /* Switch: '<S16>/Switch' incorporates: |
| 9280 | * Constant: '<S16>/Constant7' |
| 9281 | * Constant: '<S16>/Constant8' |
| 9282 | */ |
| 9283 | if (fusionAlg_B.DataTypeConversion_cgy > fusionAlg_P_g.Switch_Threshold_b) { |
| 9284 | fusionAlg_B.Switch_e = fusionAlg_P_g.Constant7_Value_fo; |
| 9285 | } else { |
| 9286 | fusionAlg_B.Switch_e = fusionAlg_P_g.Constant8_Value_h; |
| 9287 | } |
| 9288 | |
| 9289 | /* End of Switch: '<S16>/Switch' */ |
| 9290 | |
| 9291 | /* DataTypeConversion: '<S16>/Data Type Conversion1' */ |
| 9292 | tmp = (real32_T)floor(fusionAlg_B.Selector9_j.DynProp); |
| 9293 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9294 | tmp = 0.0F; |
| 9295 | } else { |
| 9296 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9297 | } |
| 9298 | |
| 9299 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objMotionPattern = (uint8_T) |
| 9300 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9301 | tmp); |
| 9302 | |
| 9303 | /* End of DataTypeConversion: '<S16>/Data Type Conversion1' */ |
| 9304 | |
| 9305 | /* BusCreator: '<S16>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9306 | * Constant: '<S16>/Constant' |
| 9307 | * Constant: '<S16>/Constant1' |
| 9308 | */ |
| 9309 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.reserved.reserved1 = |
| 9310 | fusionAlg_P_g.Constant_Value_lof; |
| 9311 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.reserved.reserved0 = |
| 9312 | fusionAlg_P_g.Constant1_Value_o2; |
| 9313 | |
| 9314 | /* BusCreator: '<S16>/Bus Creator1' incorporates: |
| 9315 | * Constant: '<S16>/Constant10' |
| 9316 | * Constant: '<S16>/Constant2' |
| 9317 | * Constant: '<S16>/Constant3' |
| 9318 | * Constant: '<S16>/Constant4' |
| 9319 | * Constant: '<S16>/Constant5' |
| 9320 | * Constant: '<S16>/Constant6' |
| 9321 | * Constant: '<S16>/Constant9' |
| 9322 | */ |
| 9323 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objObstacleProb = |
| 9324 | fusionAlg_B.Selector9_j.RCS; |
| 9325 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objXPos_Stdev = |
| 9326 | fusionAlg_P_g.Constant2_Value_a; |
| 9327 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objYPos_Stdev = |
| 9328 | fusionAlg_P_g.Constant3_Value_lt; |
| 9329 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objXVelRel_Stdev = |
| 9330 | fusionAlg_P_g.Constant4_Value_o; |
| 9331 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objXAccRel = |
| 9332 | fusionAlg_P_g.Constant5_Value_n; |
| 9333 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objExstProb = |
| 9334 | fusionAlg_P_g.Constant6_Value_m; |
| 9335 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objYVelRel = |
| 9336 | fusionAlg_B.Selector9_j.VrelLat; |
| 9337 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objXVelRel = |
| 9338 | fusionAlg_B.Selector9_j.VrelLong; |
| 9339 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objXPos = |
| 9340 | fusionAlg_B.Selector9_j.DistLong; |
| 9341 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objYPos = |
| 9342 | fusionAlg_B.Selector9_j.DistLat; |
| 9343 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objID = |
| 9344 | fusionAlg_B.DataTypeConversion_cgy; |
| 9345 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objUpdateFlag = |
| 9346 | fusionAlg_B.Switch_e; |
| 9347 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objValidFlag = |
| 9348 | fusionAlg_B.Switch_e; |
| 9349 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objType = |
| 9350 | fusionAlg_P_g.Constant9_Value_dx; |
| 9351 | fusionAlg_B.BusCreator_i.radarObj.radar_10_obj.objMeasFlag = |
| 9352 | fusionAlg_P_g.Constant10_Value_j; |
| 9353 | |
| 9354 | /* Selector: '<S13>/Selector10' incorporates: |
| 9355 | * Constant: '<S13>/Constant10' |
| 9356 | */ |
| 9357 | fusionAlg_B.Selector10_d = rtu_Radar308_Info_st-> |
| 9358 | leftFrontRadar_General[fusionAlg_P_g.Constant10_Value_h]; |
| 9359 | |
| 9360 | /* DataTypeConversion: '<S17>/Data Type Conversion' */ |
| 9361 | tmp = (real32_T)floor(fusionAlg_B.Selector10_d.ID); |
| 9362 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9363 | tmp = 0.0F; |
| 9364 | } else { |
| 9365 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9366 | } |
| 9367 | |
| 9368 | fusionAlg_B.DataTypeConversion_kh = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 9369 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9370 | |
| 9371 | /* End of DataTypeConversion: '<S17>/Data Type Conversion' */ |
| 9372 | |
| 9373 | /* Switch: '<S17>/Switch' incorporates: |
| 9374 | * Constant: '<S17>/Constant7' |
| 9375 | * Constant: '<S17>/Constant8' |
| 9376 | */ |
| 9377 | if (fusionAlg_B.DataTypeConversion_kh > fusionAlg_P_g.Switch_Threshold_dv) { |
| 9378 | fusionAlg_B.Switch_b = fusionAlg_P_g.Constant7_Value_i; |
| 9379 | } else { |
| 9380 | fusionAlg_B.Switch_b = fusionAlg_P_g.Constant8_Value_bv; |
| 9381 | } |
| 9382 | |
| 9383 | /* End of Switch: '<S17>/Switch' */ |
| 9384 | |
| 9385 | /* DataTypeConversion: '<S17>/Data Type Conversion1' */ |
| 9386 | tmp = (real32_T)floor(fusionAlg_B.Selector10_d.DynProp); |
| 9387 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9388 | tmp = 0.0F; |
| 9389 | } else { |
| 9390 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9391 | } |
| 9392 | |
| 9393 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objMotionPattern = (uint8_T) |
| 9394 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9395 | tmp); |
| 9396 | |
| 9397 | /* End of DataTypeConversion: '<S17>/Data Type Conversion1' */ |
| 9398 | |
| 9399 | /* BusCreator: '<S17>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9400 | * Constant: '<S17>/Constant' |
| 9401 | * Constant: '<S17>/Constant1' |
| 9402 | */ |
| 9403 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.reserved.reserved1 = |
| 9404 | fusionAlg_P_g.Constant_Value_ka; |
| 9405 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.reserved.reserved0 = |
| 9406 | fusionAlg_P_g.Constant1_Value_gg; |
| 9407 | |
| 9408 | /* BusCreator: '<S17>/Bus Creator1' incorporates: |
| 9409 | * Constant: '<S17>/Constant10' |
| 9410 | * Constant: '<S17>/Constant2' |
| 9411 | * Constant: '<S17>/Constant3' |
| 9412 | * Constant: '<S17>/Constant4' |
| 9413 | * Constant: '<S17>/Constant5' |
| 9414 | * Constant: '<S17>/Constant6' |
| 9415 | * Constant: '<S17>/Constant9' |
| 9416 | */ |
| 9417 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objObstacleProb = |
| 9418 | fusionAlg_B.Selector10_d.RCS; |
| 9419 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objXPos_Stdev = |
| 9420 | fusionAlg_P_g.Constant2_Value_g; |
| 9421 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objYPos_Stdev = |
| 9422 | fusionAlg_P_g.Constant3_Value_h; |
| 9423 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objXVelRel_Stdev = |
| 9424 | fusionAlg_P_g.Constant4_Value_f; |
| 9425 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objXAccRel = |
| 9426 | fusionAlg_P_g.Constant5_Value_c; |
| 9427 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objExstProb = |
| 9428 | fusionAlg_P_g.Constant6_Value_e; |
| 9429 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objYVelRel = |
| 9430 | fusionAlg_B.Selector10_d.VrelLat; |
| 9431 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objXVelRel = |
| 9432 | fusionAlg_B.Selector10_d.VrelLong; |
| 9433 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objXPos = |
| 9434 | fusionAlg_B.Selector10_d.DistLong; |
| 9435 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objYPos = |
| 9436 | fusionAlg_B.Selector10_d.DistLat; |
| 9437 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objID = |
| 9438 | fusionAlg_B.DataTypeConversion_kh; |
| 9439 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objUpdateFlag = |
| 9440 | fusionAlg_B.Switch_b; |
| 9441 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objValidFlag = |
| 9442 | fusionAlg_B.Switch_b; |
| 9443 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objType = |
| 9444 | fusionAlg_P_g.Constant9_Value_o4; |
| 9445 | fusionAlg_B.BusCreator_i.radarObj.radar_11_obj.objMeasFlag = |
| 9446 | fusionAlg_P_g.Constant10_Value_ez; |
| 9447 | |
| 9448 | /* Selector: '<S13>/Selector11' incorporates: |
| 9449 | * Constant: '<S13>/Constant11' |
| 9450 | */ |
| 9451 | fusionAlg_B.Selector11_j = rtu_Radar308_Info_st-> |
| 9452 | leftFrontRadar_General[fusionAlg_P_g.Constant11_Value]; |
| 9453 | |
| 9454 | /* DataTypeConversion: '<S18>/Data Type Conversion' */ |
| 9455 | tmp = (real32_T)floor(fusionAlg_B.Selector11_j.ID); |
| 9456 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9457 | tmp = 0.0F; |
| 9458 | } else { |
| 9459 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9460 | } |
| 9461 | |
| 9462 | fusionAlg_B.DataTypeConversion_hu = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 9463 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9464 | |
| 9465 | /* End of DataTypeConversion: '<S18>/Data Type Conversion' */ |
| 9466 | |
| 9467 | /* Switch: '<S18>/Switch' incorporates: |
| 9468 | * Constant: '<S18>/Constant7' |
| 9469 | * Constant: '<S18>/Constant8' |
| 9470 | */ |
| 9471 | if (fusionAlg_B.DataTypeConversion_hu > fusionAlg_P_g.Switch_Threshold_o) { |
| 9472 | fusionAlg_B.Switch_pz = fusionAlg_P_g.Constant7_Value_c; |
| 9473 | } else { |
| 9474 | fusionAlg_B.Switch_pz = fusionAlg_P_g.Constant8_Value_g; |
| 9475 | } |
| 9476 | |
| 9477 | /* End of Switch: '<S18>/Switch' */ |
| 9478 | |
| 9479 | /* DataTypeConversion: '<S18>/Data Type Conversion1' */ |
| 9480 | tmp = (real32_T)floor(fusionAlg_B.Selector11_j.DynProp); |
| 9481 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9482 | tmp = 0.0F; |
| 9483 | } else { |
| 9484 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9485 | } |
| 9486 | |
| 9487 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objMotionPattern = (uint8_T) |
| 9488 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9489 | tmp); |
| 9490 | |
| 9491 | /* End of DataTypeConversion: '<S18>/Data Type Conversion1' */ |
| 9492 | |
| 9493 | /* BusCreator: '<S18>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9494 | * Constant: '<S18>/Constant' |
| 9495 | * Constant: '<S18>/Constant1' |
| 9496 | */ |
| 9497 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.reserved.reserved1 = |
| 9498 | fusionAlg_P_g.Constant_Value_fgp; |
| 9499 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.reserved.reserved0 = |
| 9500 | fusionAlg_P_g.Constant1_Value_d30; |
| 9501 | |
| 9502 | /* BusCreator: '<S18>/Bus Creator1' incorporates: |
| 9503 | * Constant: '<S18>/Constant10' |
| 9504 | * Constant: '<S18>/Constant2' |
| 9505 | * Constant: '<S18>/Constant3' |
| 9506 | * Constant: '<S18>/Constant4' |
| 9507 | * Constant: '<S18>/Constant5' |
| 9508 | * Constant: '<S18>/Constant6' |
| 9509 | * Constant: '<S18>/Constant9' |
| 9510 | */ |
| 9511 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objObstacleProb = |
| 9512 | fusionAlg_B.Selector11_j.RCS; |
| 9513 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objXPos_Stdev = |
| 9514 | fusionAlg_P_g.Constant2_Value_n; |
| 9515 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objYPos_Stdev = |
| 9516 | fusionAlg_P_g.Constant3_Value_n; |
| 9517 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objXVelRel_Stdev = |
| 9518 | fusionAlg_P_g.Constant4_Value_h; |
| 9519 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objXAccRel = |
| 9520 | fusionAlg_P_g.Constant5_Value_f; |
| 9521 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objExstProb = |
| 9522 | fusionAlg_P_g.Constant6_Value_f; |
| 9523 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objYVelRel = |
| 9524 | fusionAlg_B.Selector11_j.VrelLat; |
| 9525 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objXVelRel = |
| 9526 | fusionAlg_B.Selector11_j.VrelLong; |
| 9527 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objXPos = |
| 9528 | fusionAlg_B.Selector11_j.DistLong; |
| 9529 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objYPos = |
| 9530 | fusionAlg_B.Selector11_j.DistLat; |
| 9531 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objID = |
| 9532 | fusionAlg_B.DataTypeConversion_hu; |
| 9533 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objUpdateFlag = |
| 9534 | fusionAlg_B.Switch_pz; |
| 9535 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objValidFlag = |
| 9536 | fusionAlg_B.Switch_pz; |
| 9537 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objType = |
| 9538 | fusionAlg_P_g.Constant9_Value_ds; |
| 9539 | fusionAlg_B.BusCreator_i.radarObj.radar_12_obj.objMeasFlag = |
| 9540 | fusionAlg_P_g.Constant10_Value_p; |
| 9541 | |
| 9542 | /* Selector: '<S13>/Selector12' incorporates: |
| 9543 | * Constant: '<S13>/Constant12' |
| 9544 | */ |
| 9545 | fusionAlg_B.Selector12_b = rtu_Radar308_Info_st-> |
| 9546 | leftFrontRadar_General[fusionAlg_P_g.Constant12_Value]; |
| 9547 | |
| 9548 | /* DataTypeConversion: '<S19>/Data Type Conversion' */ |
| 9549 | tmp = (real32_T)floor(fusionAlg_B.Selector12_b.ID); |
| 9550 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9551 | tmp = 0.0F; |
| 9552 | } else { |
| 9553 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9554 | } |
| 9555 | |
| 9556 | fusionAlg_B.DataTypeConversion_kf = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 9557 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9558 | |
| 9559 | /* End of DataTypeConversion: '<S19>/Data Type Conversion' */ |
| 9560 | |
| 9561 | /* Switch: '<S19>/Switch' incorporates: |
| 9562 | * Constant: '<S19>/Constant7' |
| 9563 | * Constant: '<S19>/Constant8' |
| 9564 | */ |
| 9565 | if (fusionAlg_B.DataTypeConversion_kf > fusionAlg_P_g.Switch_Threshold_cs) { |
| 9566 | fusionAlg_B.Switch_kd = fusionAlg_P_g.Constant7_Value_ds; |
| 9567 | } else { |
| 9568 | fusionAlg_B.Switch_kd = fusionAlg_P_g.Constant8_Value_j; |
| 9569 | } |
| 9570 | |
| 9571 | /* End of Switch: '<S19>/Switch' */ |
| 9572 | |
| 9573 | /* DataTypeConversion: '<S19>/Data Type Conversion1' */ |
| 9574 | tmp = (real32_T)floor(fusionAlg_B.Selector12_b.DynProp); |
| 9575 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9576 | tmp = 0.0F; |
| 9577 | } else { |
| 9578 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9579 | } |
| 9580 | |
| 9581 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objMotionPattern = (uint8_T) |
| 9582 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9583 | tmp); |
| 9584 | |
| 9585 | /* End of DataTypeConversion: '<S19>/Data Type Conversion1' */ |
| 9586 | |
| 9587 | /* BusCreator: '<S19>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9588 | * Constant: '<S19>/Constant' |
| 9589 | * Constant: '<S19>/Constant1' |
| 9590 | */ |
| 9591 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.reserved.reserved1 = |
| 9592 | fusionAlg_P_g.Constant_Value_o3; |
| 9593 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.reserved.reserved0 = |
| 9594 | fusionAlg_P_g.Constant1_Value_hl3; |
| 9595 | |
| 9596 | /* BusCreator: '<S19>/Bus Creator1' incorporates: |
| 9597 | * Constant: '<S19>/Constant10' |
| 9598 | * Constant: '<S19>/Constant2' |
| 9599 | * Constant: '<S19>/Constant3' |
| 9600 | * Constant: '<S19>/Constant4' |
| 9601 | * Constant: '<S19>/Constant5' |
| 9602 | * Constant: '<S19>/Constant6' |
| 9603 | * Constant: '<S19>/Constant9' |
| 9604 | */ |
| 9605 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objObstacleProb = |
| 9606 | fusionAlg_B.Selector12_b.RCS; |
| 9607 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objXPos_Stdev = |
| 9608 | fusionAlg_P_g.Constant2_Value_h; |
| 9609 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objYPos_Stdev = |
| 9610 | fusionAlg_P_g.Constant3_Value_pr; |
| 9611 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objXVelRel_Stdev = |
| 9612 | fusionAlg_P_g.Constant4_Value_iv; |
| 9613 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objXAccRel = |
| 9614 | fusionAlg_P_g.Constant5_Value_h; |
| 9615 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objExstProb = |
| 9616 | fusionAlg_P_g.Constant6_Value_h1; |
| 9617 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objYVelRel = |
| 9618 | fusionAlg_B.Selector12_b.VrelLat; |
| 9619 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objXVelRel = |
| 9620 | fusionAlg_B.Selector12_b.VrelLong; |
| 9621 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objXPos = |
| 9622 | fusionAlg_B.Selector12_b.DistLong; |
| 9623 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objYPos = |
| 9624 | fusionAlg_B.Selector12_b.DistLat; |
| 9625 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objID = |
| 9626 | fusionAlg_B.DataTypeConversion_kf; |
| 9627 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objUpdateFlag = |
| 9628 | fusionAlg_B.Switch_kd; |
| 9629 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objValidFlag = |
| 9630 | fusionAlg_B.Switch_kd; |
| 9631 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objType = |
| 9632 | fusionAlg_P_g.Constant9_Value_k; |
| 9633 | fusionAlg_B.BusCreator_i.radarObj.radar_13_obj.objMeasFlag = |
| 9634 | fusionAlg_P_g.Constant10_Value_o2; |
| 9635 | |
| 9636 | /* Selector: '<S13>/Selector13' incorporates: |
| 9637 | * Constant: '<S13>/Constant13' |
| 9638 | */ |
| 9639 | fusionAlg_B.Selector13_c = rtu_Radar308_Info_st-> |
| 9640 | leftFrontRadar_General[fusionAlg_P_g.Constant13_Value]; |
| 9641 | |
| 9642 | /* DataTypeConversion: '<S20>/Data Type Conversion' */ |
| 9643 | tmp = (real32_T)floor(fusionAlg_B.Selector13_c.ID); |
| 9644 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9645 | tmp = 0.0F; |
| 9646 | } else { |
| 9647 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9648 | } |
| 9649 | |
| 9650 | fusionAlg_B.DataTypeConversion_be = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 9651 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9652 | |
| 9653 | /* End of DataTypeConversion: '<S20>/Data Type Conversion' */ |
| 9654 | |
| 9655 | /* Switch: '<S20>/Switch' incorporates: |
| 9656 | * Constant: '<S20>/Constant7' |
| 9657 | * Constant: '<S20>/Constant8' |
| 9658 | */ |
| 9659 | if (fusionAlg_B.DataTypeConversion_be > fusionAlg_P_g.Switch_Threshold_pz) { |
| 9660 | fusionAlg_B.Switch_bk = fusionAlg_P_g.Constant7_Value_e; |
| 9661 | } else { |
| 9662 | fusionAlg_B.Switch_bk = fusionAlg_P_g.Constant8_Value_k; |
| 9663 | } |
| 9664 | |
| 9665 | /* End of Switch: '<S20>/Switch' */ |
| 9666 | |
| 9667 | /* DataTypeConversion: '<S20>/Data Type Conversion1' */ |
| 9668 | tmp = (real32_T)floor(fusionAlg_B.Selector13_c.DynProp); |
| 9669 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9670 | tmp = 0.0F; |
| 9671 | } else { |
| 9672 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9673 | } |
| 9674 | |
| 9675 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objMotionPattern = (uint8_T) |
| 9676 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9677 | tmp); |
| 9678 | |
| 9679 | /* End of DataTypeConversion: '<S20>/Data Type Conversion1' */ |
| 9680 | |
| 9681 | /* BusCreator: '<S20>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9682 | * Constant: '<S20>/Constant' |
| 9683 | * Constant: '<S20>/Constant1' |
| 9684 | */ |
| 9685 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.reserved.reserved1 = |
| 9686 | fusionAlg_P_g.Constant_Value_byt; |
| 9687 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.reserved.reserved0 = |
| 9688 | fusionAlg_P_g.Constant1_Value_o1; |
| 9689 | |
| 9690 | /* BusCreator: '<S20>/Bus Creator1' incorporates: |
| 9691 | * Constant: '<S20>/Constant10' |
| 9692 | * Constant: '<S20>/Constant2' |
| 9693 | * Constant: '<S20>/Constant3' |
| 9694 | * Constant: '<S20>/Constant4' |
| 9695 | * Constant: '<S20>/Constant5' |
| 9696 | * Constant: '<S20>/Constant6' |
| 9697 | * Constant: '<S20>/Constant9' |
| 9698 | */ |
| 9699 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objObstacleProb = |
| 9700 | fusionAlg_B.Selector13_c.RCS; |
| 9701 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objXPos_Stdev = |
| 9702 | fusionAlg_P_g.Constant2_Value_hp; |
| 9703 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objYPos_Stdev = |
| 9704 | fusionAlg_P_g.Constant3_Value_jw; |
| 9705 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objXVelRel_Stdev = |
| 9706 | fusionAlg_P_g.Constant4_Value_op; |
| 9707 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objXAccRel = |
| 9708 | fusionAlg_P_g.Constant5_Value_of; |
| 9709 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objExstProb = |
| 9710 | fusionAlg_P_g.Constant6_Value_k5; |
| 9711 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objYVelRel = |
| 9712 | fusionAlg_B.Selector13_c.VrelLat; |
| 9713 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objXVelRel = |
| 9714 | fusionAlg_B.Selector13_c.VrelLong; |
| 9715 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objXPos = |
| 9716 | fusionAlg_B.Selector13_c.DistLong; |
| 9717 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objYPos = |
| 9718 | fusionAlg_B.Selector13_c.DistLat; |
| 9719 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objID = |
| 9720 | fusionAlg_B.DataTypeConversion_be; |
| 9721 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objUpdateFlag = |
| 9722 | fusionAlg_B.Switch_bk; |
| 9723 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objValidFlag = |
| 9724 | fusionAlg_B.Switch_bk; |
| 9725 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objType = |
| 9726 | fusionAlg_P_g.Constant9_Value_cm; |
| 9727 | fusionAlg_B.BusCreator_i.radarObj.radar_14_obj.objMeasFlag = |
| 9728 | fusionAlg_P_g.Constant10_Value_ge; |
| 9729 | |
| 9730 | /* Selector: '<S13>/Selector14' incorporates: |
| 9731 | * Constant: '<S13>/Constant14' |
| 9732 | */ |
| 9733 | fusionAlg_B.Selector14_n = rtu_Radar308_Info_st-> |
| 9734 | leftFrontRadar_General[fusionAlg_P_g.Constant14_Value]; |
| 9735 | |
| 9736 | /* DataTypeConversion: '<S21>/Data Type Conversion' */ |
| 9737 | tmp = (real32_T)floor(fusionAlg_B.Selector14_n.ID); |
| 9738 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9739 | tmp = 0.0F; |
| 9740 | } else { |
| 9741 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9742 | } |
| 9743 | |
| 9744 | fusionAlg_B.DataTypeConversion_b0 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 9745 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9746 | |
| 9747 | /* End of DataTypeConversion: '<S21>/Data Type Conversion' */ |
| 9748 | |
| 9749 | /* Switch: '<S21>/Switch' incorporates: |
| 9750 | * Constant: '<S21>/Constant7' |
| 9751 | * Constant: '<S21>/Constant8' |
| 9752 | */ |
| 9753 | if (fusionAlg_B.DataTypeConversion_b0 > fusionAlg_P_g.Switch_Threshold_l) { |
| 9754 | fusionAlg_B.Switch_h = fusionAlg_P_g.Constant7_Value_p; |
| 9755 | } else { |
| 9756 | fusionAlg_B.Switch_h = fusionAlg_P_g.Constant8_Value_d0; |
| 9757 | } |
| 9758 | |
| 9759 | /* End of Switch: '<S21>/Switch' */ |
| 9760 | |
| 9761 | /* DataTypeConversion: '<S21>/Data Type Conversion1' */ |
| 9762 | tmp = (real32_T)floor(fusionAlg_B.Selector14_n.DynProp); |
| 9763 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9764 | tmp = 0.0F; |
| 9765 | } else { |
| 9766 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9767 | } |
| 9768 | |
| 9769 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objMotionPattern = (uint8_T) |
| 9770 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9771 | tmp); |
| 9772 | |
| 9773 | /* End of DataTypeConversion: '<S21>/Data Type Conversion1' */ |
| 9774 | |
| 9775 | /* BusCreator: '<S21>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9776 | * Constant: '<S21>/Constant' |
| 9777 | * Constant: '<S21>/Constant1' |
| 9778 | */ |
| 9779 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.reserved.reserved1 = |
| 9780 | fusionAlg_P_g.Constant_Value_h4; |
| 9781 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.reserved.reserved0 = |
| 9782 | fusionAlg_P_g.Constant1_Value_o1p; |
| 9783 | |
| 9784 | /* BusCreator: '<S21>/Bus Creator1' incorporates: |
| 9785 | * Constant: '<S21>/Constant10' |
| 9786 | * Constant: '<S21>/Constant2' |
| 9787 | * Constant: '<S21>/Constant3' |
| 9788 | * Constant: '<S21>/Constant4' |
| 9789 | * Constant: '<S21>/Constant5' |
| 9790 | * Constant: '<S21>/Constant6' |
| 9791 | * Constant: '<S21>/Constant9' |
| 9792 | */ |
| 9793 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objObstacleProb = |
| 9794 | fusionAlg_B.Selector14_n.RCS; |
| 9795 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objXPos_Stdev = |
| 9796 | fusionAlg_P_g.Constant2_Value_e; |
| 9797 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objYPos_Stdev = |
| 9798 | fusionAlg_P_g.Constant3_Value_ap; |
| 9799 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objXVelRel_Stdev = |
| 9800 | fusionAlg_P_g.Constant4_Value_l; |
| 9801 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objXAccRel = |
| 9802 | fusionAlg_P_g.Constant5_Value_ev; |
| 9803 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objExstProb = |
| 9804 | fusionAlg_P_g.Constant6_Value_bi; |
| 9805 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objYVelRel = |
| 9806 | fusionAlg_B.Selector14_n.VrelLat; |
| 9807 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objXVelRel = |
| 9808 | fusionAlg_B.Selector14_n.VrelLong; |
| 9809 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objXPos = |
| 9810 | fusionAlg_B.Selector14_n.DistLong; |
| 9811 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objYPos = |
| 9812 | fusionAlg_B.Selector14_n.DistLat; |
| 9813 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objID = |
| 9814 | fusionAlg_B.DataTypeConversion_b0; |
| 9815 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objUpdateFlag = |
| 9816 | fusionAlg_B.Switch_h; |
| 9817 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objValidFlag = |
| 9818 | fusionAlg_B.Switch_h; |
| 9819 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objType = |
| 9820 | fusionAlg_P_g.Constant9_Value_ph; |
| 9821 | fusionAlg_B.BusCreator_i.radarObj.radar_15_obj.objMeasFlag = |
| 9822 | fusionAlg_P_g.Constant10_Value_dt; |
| 9823 | |
| 9824 | /* Selector: '<S13>/Selector15' incorporates: |
| 9825 | * Constant: '<S13>/Constant15' |
| 9826 | */ |
| 9827 | fusionAlg_B.Selector15_i = rtu_Radar308_Info_st-> |
| 9828 | leftFrontRadar_General[fusionAlg_P_g.Constant15_Value]; |
| 9829 | |
| 9830 | /* DataTypeConversion: '<S22>/Data Type Conversion' */ |
| 9831 | tmp = (real32_T)floor(fusionAlg_B.Selector15_i.ID); |
| 9832 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9833 | tmp = 0.0F; |
| 9834 | } else { |
| 9835 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9836 | } |
| 9837 | |
| 9838 | fusionAlg_B.DataTypeConversion_bx = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 9839 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9840 | |
| 9841 | /* End of DataTypeConversion: '<S22>/Data Type Conversion' */ |
| 9842 | |
| 9843 | /* Switch: '<S22>/Switch' incorporates: |
| 9844 | * Constant: '<S22>/Constant7' |
| 9845 | * Constant: '<S22>/Constant8' |
| 9846 | */ |
| 9847 | if (fusionAlg_B.DataTypeConversion_bx > fusionAlg_P_g.Switch_Threshold_h) { |
| 9848 | fusionAlg_B.Switch_e5 = fusionAlg_P_g.Constant7_Value_a; |
| 9849 | } else { |
| 9850 | fusionAlg_B.Switch_e5 = fusionAlg_P_g.Constant8_Value_kp; |
| 9851 | } |
| 9852 | |
| 9853 | /* End of Switch: '<S22>/Switch' */ |
| 9854 | |
| 9855 | /* DataTypeConversion: '<S22>/Data Type Conversion1' */ |
| 9856 | tmp = (real32_T)floor(fusionAlg_B.Selector15_i.DynProp); |
| 9857 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9858 | tmp = 0.0F; |
| 9859 | } else { |
| 9860 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9861 | } |
| 9862 | |
| 9863 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objMotionPattern = (uint8_T) |
| 9864 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9865 | tmp); |
| 9866 | |
| 9867 | /* End of DataTypeConversion: '<S22>/Data Type Conversion1' */ |
| 9868 | |
| 9869 | /* BusCreator: '<S22>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9870 | * Constant: '<S22>/Constant' |
| 9871 | * Constant: '<S22>/Constant1' |
| 9872 | */ |
| 9873 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.reserved.reserved1 = |
| 9874 | fusionAlg_P_g.Constant_Value_mo; |
| 9875 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.reserved.reserved0 = |
| 9876 | fusionAlg_P_g.Constant1_Value_en; |
| 9877 | |
| 9878 | /* BusCreator: '<S22>/Bus Creator1' incorporates: |
| 9879 | * Constant: '<S22>/Constant10' |
| 9880 | * Constant: '<S22>/Constant2' |
| 9881 | * Constant: '<S22>/Constant3' |
| 9882 | * Constant: '<S22>/Constant4' |
| 9883 | * Constant: '<S22>/Constant5' |
| 9884 | * Constant: '<S22>/Constant6' |
| 9885 | * Constant: '<S22>/Constant9' |
| 9886 | */ |
| 9887 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objObstacleProb = |
| 9888 | fusionAlg_B.Selector15_i.RCS; |
| 9889 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objXPos_Stdev = |
| 9890 | fusionAlg_P_g.Constant2_Value_fq; |
| 9891 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objYPos_Stdev = |
| 9892 | fusionAlg_P_g.Constant3_Value_b; |
| 9893 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objXVelRel_Stdev = |
| 9894 | fusionAlg_P_g.Constant4_Value_ln; |
| 9895 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objXAccRel = |
| 9896 | fusionAlg_P_g.Constant5_Value_ov; |
| 9897 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objExstProb = |
| 9898 | fusionAlg_P_g.Constant6_Value_hl; |
| 9899 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objYVelRel = |
| 9900 | fusionAlg_B.Selector15_i.VrelLat; |
| 9901 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objXVelRel = |
| 9902 | fusionAlg_B.Selector15_i.VrelLong; |
| 9903 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objXPos = |
| 9904 | fusionAlg_B.Selector15_i.DistLong; |
| 9905 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objYPos = |
| 9906 | fusionAlg_B.Selector15_i.DistLat; |
| 9907 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objID = |
| 9908 | fusionAlg_B.DataTypeConversion_bx; |
| 9909 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objUpdateFlag = |
| 9910 | fusionAlg_B.Switch_e5; |
| 9911 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objValidFlag = |
| 9912 | fusionAlg_B.Switch_e5; |
| 9913 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objType = |
| 9914 | fusionAlg_P_g.Constant9_Value_fm; |
| 9915 | fusionAlg_B.BusCreator_i.radarObj.radar_16_obj.objMeasFlag = |
| 9916 | fusionAlg_P_g.Constant10_Value_bw; |
| 9917 | |
| 9918 | /* Selector: '<S13>/Selector16' incorporates: |
| 9919 | * Constant: '<S13>/Constant16' |
| 9920 | */ |
| 9921 | fusionAlg_B.Selector16_b = rtu_Radar308_Info_st-> |
| 9922 | leftFrontRadar_General[fusionAlg_P_g.Constant16_Value]; |
| 9923 | |
| 9924 | /* DataTypeConversion: '<S23>/Data Type Conversion' */ |
| 9925 | tmp = (real32_T)floor(fusionAlg_B.Selector16_b.ID); |
| 9926 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9927 | tmp = 0.0F; |
| 9928 | } else { |
| 9929 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 9930 | } |
| 9931 | |
| 9932 | fusionAlg_B.DataTypeConversion_ef = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 9933 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 9934 | |
| 9935 | /* End of DataTypeConversion: '<S23>/Data Type Conversion' */ |
| 9936 | |
| 9937 | /* Switch: '<S23>/Switch' incorporates: |
| 9938 | * Constant: '<S23>/Constant7' |
| 9939 | * Constant: '<S23>/Constant8' |
| 9940 | */ |
| 9941 | if (fusionAlg_B.DataTypeConversion_ef > fusionAlg_P_g.Switch_Threshold_dm) { |
| 9942 | fusionAlg_B.Switch_l = fusionAlg_P_g.Constant7_Value_jj; |
| 9943 | } else { |
| 9944 | fusionAlg_B.Switch_l = fusionAlg_P_g.Constant8_Value_hl; |
| 9945 | } |
| 9946 | |
| 9947 | /* End of Switch: '<S23>/Switch' */ |
| 9948 | |
| 9949 | /* DataTypeConversion: '<S23>/Data Type Conversion1' */ |
| 9950 | tmp = (real32_T)floor(fusionAlg_B.Selector16_b.DynProp); |
| 9951 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 9952 | tmp = 0.0F; |
| 9953 | } else { |
| 9954 | tmp = (real32_T)fmod(tmp, 256.0); |
| 9955 | } |
| 9956 | |
| 9957 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objMotionPattern = (uint8_T) |
| 9958 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 9959 | tmp); |
| 9960 | |
| 9961 | /* End of DataTypeConversion: '<S23>/Data Type Conversion1' */ |
| 9962 | |
| 9963 | /* BusCreator: '<S23>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 9964 | * Constant: '<S23>/Constant' |
| 9965 | * Constant: '<S23>/Constant1' |
| 9966 | */ |
| 9967 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.reserved.reserved1 = |
| 9968 | fusionAlg_P_g.Constant_Value_p0; |
| 9969 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.reserved.reserved0 = |
| 9970 | fusionAlg_P_g.Constant1_Value_po; |
| 9971 | |
| 9972 | /* BusCreator: '<S23>/Bus Creator1' incorporates: |
| 9973 | * Constant: '<S23>/Constant10' |
| 9974 | * Constant: '<S23>/Constant2' |
| 9975 | * Constant: '<S23>/Constant3' |
| 9976 | * Constant: '<S23>/Constant4' |
| 9977 | * Constant: '<S23>/Constant5' |
| 9978 | * Constant: '<S23>/Constant6' |
| 9979 | * Constant: '<S23>/Constant9' |
| 9980 | */ |
| 9981 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objObstacleProb = |
| 9982 | fusionAlg_B.Selector16_b.RCS; |
| 9983 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objXPos_Stdev = |
| 9984 | fusionAlg_P_g.Constant2_Value_gb; |
| 9985 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objYPos_Stdev = |
| 9986 | fusionAlg_P_g.Constant3_Value_ax; |
| 9987 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objXVelRel_Stdev = |
| 9988 | fusionAlg_P_g.Constant4_Value_e; |
| 9989 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objXAccRel = |
| 9990 | fusionAlg_P_g.Constant5_Value_hv; |
| 9991 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objExstProb = |
| 9992 | fusionAlg_P_g.Constant6_Value_is; |
| 9993 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objYVelRel = |
| 9994 | fusionAlg_B.Selector16_b.VrelLat; |
| 9995 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objXVelRel = |
| 9996 | fusionAlg_B.Selector16_b.VrelLong; |
| 9997 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objXPos = |
| 9998 | fusionAlg_B.Selector16_b.DistLong; |
| 9999 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objYPos = |
| 10000 | fusionAlg_B.Selector16_b.DistLat; |
| 10001 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objID = |
| 10002 | fusionAlg_B.DataTypeConversion_ef; |
| 10003 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objUpdateFlag = |
| 10004 | fusionAlg_B.Switch_l; |
| 10005 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objValidFlag = |
| 10006 | fusionAlg_B.Switch_l; |
| 10007 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objType = |
| 10008 | fusionAlg_P_g.Constant9_Value_n; |
| 10009 | fusionAlg_B.BusCreator_i.radarObj.radar_17_obj.objMeasFlag = |
| 10010 | fusionAlg_P_g.Constant10_Value_k; |
| 10011 | |
| 10012 | /* Selector: '<S13>/Selector24' incorporates: |
| 10013 | * Constant: '<S13>/Constant17' |
| 10014 | */ |
| 10015 | fusionAlg_B.Selector24_p = rtu_Radar308_Info_st-> |
| 10016 | leftFrontRadar_General[fusionAlg_P_g.Constant17_Value]; |
| 10017 | |
| 10018 | /* DataTypeConversion: '<S24>/Data Type Conversion' */ |
| 10019 | tmp = (real32_T)floor(fusionAlg_B.Selector24_p.ID); |
| 10020 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10021 | tmp = 0.0F; |
| 10022 | } else { |
| 10023 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10024 | } |
| 10025 | |
| 10026 | fusionAlg_B.DataTypeConversion_c5y = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 10027 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10028 | |
| 10029 | /* End of DataTypeConversion: '<S24>/Data Type Conversion' */ |
| 10030 | |
| 10031 | /* Switch: '<S24>/Switch' incorporates: |
| 10032 | * Constant: '<S24>/Constant7' |
| 10033 | * Constant: '<S24>/Constant8' |
| 10034 | */ |
| 10035 | if (fusionAlg_B.DataTypeConversion_c5y > fusionAlg_P_g.Switch_Threshold_k) { |
| 10036 | fusionAlg_B.Switch_f = fusionAlg_P_g.Constant7_Value_p5; |
| 10037 | } else { |
| 10038 | fusionAlg_B.Switch_f = fusionAlg_P_g.Constant8_Value_be; |
| 10039 | } |
| 10040 | |
| 10041 | /* End of Switch: '<S24>/Switch' */ |
| 10042 | |
| 10043 | /* DataTypeConversion: '<S24>/Data Type Conversion1' */ |
| 10044 | tmp = (real32_T)floor(fusionAlg_B.Selector24_p.DynProp); |
| 10045 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10046 | tmp = 0.0F; |
| 10047 | } else { |
| 10048 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10049 | } |
| 10050 | |
| 10051 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objMotionPattern = (uint8_T) |
| 10052 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10053 | tmp); |
| 10054 | |
| 10055 | /* End of DataTypeConversion: '<S24>/Data Type Conversion1' */ |
| 10056 | |
| 10057 | /* BusCreator: '<S24>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10058 | * Constant: '<S24>/Constant' |
| 10059 | * Constant: '<S24>/Constant1' |
| 10060 | */ |
| 10061 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.reserved.reserved1 = |
| 10062 | fusionAlg_P_g.Constant_Value_kq; |
| 10063 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.reserved.reserved0 = |
| 10064 | fusionAlg_P_g.Constant1_Value_hms; |
| 10065 | |
| 10066 | /* BusCreator: '<S24>/Bus Creator1' incorporates: |
| 10067 | * Constant: '<S24>/Constant10' |
| 10068 | * Constant: '<S24>/Constant2' |
| 10069 | * Constant: '<S24>/Constant3' |
| 10070 | * Constant: '<S24>/Constant4' |
| 10071 | * Constant: '<S24>/Constant5' |
| 10072 | * Constant: '<S24>/Constant6' |
| 10073 | * Constant: '<S24>/Constant9' |
| 10074 | */ |
| 10075 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objObstacleProb = |
| 10076 | fusionAlg_B.Selector24_p.RCS; |
| 10077 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objXPos_Stdev = |
| 10078 | fusionAlg_P_g.Constant2_Value_c; |
| 10079 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objYPos_Stdev = |
| 10080 | fusionAlg_P_g.Constant3_Value_ag; |
| 10081 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objXVelRel_Stdev = |
| 10082 | fusionAlg_P_g.Constant4_Value_bk; |
| 10083 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objXAccRel = |
| 10084 | fusionAlg_P_g.Constant5_Value_l0; |
| 10085 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objExstProb = |
| 10086 | fusionAlg_P_g.Constant6_Value_cp; |
| 10087 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objYVelRel = |
| 10088 | fusionAlg_B.Selector24_p.VrelLat; |
| 10089 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objXVelRel = |
| 10090 | fusionAlg_B.Selector24_p.VrelLong; |
| 10091 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objXPos = |
| 10092 | fusionAlg_B.Selector24_p.DistLong; |
| 10093 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objYPos = |
| 10094 | fusionAlg_B.Selector24_p.DistLat; |
| 10095 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objID = |
| 10096 | fusionAlg_B.DataTypeConversion_c5y; |
| 10097 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objUpdateFlag = |
| 10098 | fusionAlg_B.Switch_f; |
| 10099 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objValidFlag = |
| 10100 | fusionAlg_B.Switch_f; |
| 10101 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objType = |
| 10102 | fusionAlg_P_g.Constant9_Value_fo; |
| 10103 | fusionAlg_B.BusCreator_i.radarObj.radar_18_obj.objMeasFlag = |
| 10104 | fusionAlg_P_g.Constant10_Value_hm; |
| 10105 | |
| 10106 | /* Selector: '<S13>/Selector25' incorporates: |
| 10107 | * Constant: '<S13>/Constant18' |
| 10108 | */ |
| 10109 | fusionAlg_B.Selector25_p = rtu_Radar308_Info_st-> |
| 10110 | leftFrontRadar_General[fusionAlg_P_g.Constant18_Value]; |
| 10111 | |
| 10112 | /* DataTypeConversion: '<S25>/Data Type Conversion' */ |
| 10113 | tmp = (real32_T)floor(fusionAlg_B.Selector25_p.ID); |
| 10114 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10115 | tmp = 0.0F; |
| 10116 | } else { |
| 10117 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10118 | } |
| 10119 | |
| 10120 | fusionAlg_B.DataTypeConversion_by3 = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 10121 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10122 | |
| 10123 | /* End of DataTypeConversion: '<S25>/Data Type Conversion' */ |
| 10124 | |
| 10125 | /* Switch: '<S25>/Switch' incorporates: |
| 10126 | * Constant: '<S25>/Constant7' |
| 10127 | * Constant: '<S25>/Constant8' |
| 10128 | */ |
| 10129 | if (fusionAlg_B.DataTypeConversion_by3 > fusionAlg_P_g.Switch_Threshold_hc) { |
| 10130 | fusionAlg_B.Switch_n = fusionAlg_P_g.Constant7_Value_mk; |
| 10131 | } else { |
| 10132 | fusionAlg_B.Switch_n = fusionAlg_P_g.Constant8_Value_m3u; |
| 10133 | } |
| 10134 | |
| 10135 | /* End of Switch: '<S25>/Switch' */ |
| 10136 | |
| 10137 | /* DataTypeConversion: '<S25>/Data Type Conversion1' */ |
| 10138 | tmp = (real32_T)floor(fusionAlg_B.Selector25_p.DynProp); |
| 10139 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10140 | tmp = 0.0F; |
| 10141 | } else { |
| 10142 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10143 | } |
| 10144 | |
| 10145 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objMotionPattern = (uint8_T) |
| 10146 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10147 | tmp); |
| 10148 | |
| 10149 | /* End of DataTypeConversion: '<S25>/Data Type Conversion1' */ |
| 10150 | |
| 10151 | /* BusCreator: '<S25>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10152 | * Constant: '<S25>/Constant' |
| 10153 | * Constant: '<S25>/Constant1' |
| 10154 | */ |
| 10155 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.reserved.reserved1 = |
| 10156 | fusionAlg_P_g.Constant_Value_lcl; |
| 10157 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.reserved.reserved0 = |
| 10158 | fusionAlg_P_g.Constant1_Value_gh; |
| 10159 | |
| 10160 | /* BusCreator: '<S25>/Bus Creator1' incorporates: |
| 10161 | * Constant: '<S25>/Constant10' |
| 10162 | * Constant: '<S25>/Constant2' |
| 10163 | * Constant: '<S25>/Constant3' |
| 10164 | * Constant: '<S25>/Constant4' |
| 10165 | * Constant: '<S25>/Constant5' |
| 10166 | * Constant: '<S25>/Constant6' |
| 10167 | * Constant: '<S25>/Constant9' |
| 10168 | */ |
| 10169 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objObstacleProb = |
| 10170 | fusionAlg_B.Selector25_p.RCS; |
| 10171 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objXPos_Stdev = |
| 10172 | fusionAlg_P_g.Constant2_Value_o; |
| 10173 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objYPos_Stdev = |
| 10174 | fusionAlg_P_g.Constant3_Value_mb; |
| 10175 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objXVelRel_Stdev = |
| 10176 | fusionAlg_P_g.Constant4_Value_o3; |
| 10177 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objXAccRel = |
| 10178 | fusionAlg_P_g.Constant5_Value_c2; |
| 10179 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objExstProb = |
| 10180 | fusionAlg_P_g.Constant6_Value_d; |
| 10181 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objYVelRel = |
| 10182 | fusionAlg_B.Selector25_p.VrelLat; |
| 10183 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objXVelRel = |
| 10184 | fusionAlg_B.Selector25_p.VrelLong; |
| 10185 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objXPos = |
| 10186 | fusionAlg_B.Selector25_p.DistLong; |
| 10187 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objYPos = |
| 10188 | fusionAlg_B.Selector25_p.DistLat; |
| 10189 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objID = |
| 10190 | fusionAlg_B.DataTypeConversion_by3; |
| 10191 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objUpdateFlag = |
| 10192 | fusionAlg_B.Switch_n; |
| 10193 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objValidFlag = |
| 10194 | fusionAlg_B.Switch_n; |
| 10195 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objType = |
| 10196 | fusionAlg_P_g.Constant9_Value_du; |
| 10197 | fusionAlg_B.BusCreator_i.radarObj.radar_19_obj.objMeasFlag = |
| 10198 | fusionAlg_P_g.Constant10_Value_it; |
| 10199 | |
| 10200 | /* Selector: '<S13>/Selector26' incorporates: |
| 10201 | * Constant: '<S13>/Constant19' |
| 10202 | */ |
| 10203 | fusionAlg_B.Selector26_a = rtu_Radar308_Info_st-> |
| 10204 | leftFrontRadar_General[fusionAlg_P_g.Constant19_Value]; |
| 10205 | |
| 10206 | /* DataTypeConversion: '<S27>/Data Type Conversion' */ |
| 10207 | tmp = (real32_T)floor(fusionAlg_B.Selector26_a.ID); |
| 10208 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10209 | tmp = 0.0F; |
| 10210 | } else { |
| 10211 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10212 | } |
| 10213 | |
| 10214 | fusionAlg_B.DataTypeConversion_jw = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 10215 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10216 | |
| 10217 | /* End of DataTypeConversion: '<S27>/Data Type Conversion' */ |
| 10218 | |
| 10219 | /* Switch: '<S27>/Switch' incorporates: |
| 10220 | * Constant: '<S27>/Constant7' |
| 10221 | * Constant: '<S27>/Constant8' |
| 10222 | */ |
| 10223 | if (fusionAlg_B.DataTypeConversion_jw > fusionAlg_P_g.Switch_Threshold_n) { |
| 10224 | fusionAlg_B.Switch_o = fusionAlg_P_g.Constant7_Value_ai; |
| 10225 | } else { |
| 10226 | fusionAlg_B.Switch_o = fusionAlg_P_g.Constant8_Value_e; |
| 10227 | } |
| 10228 | |
| 10229 | /* End of Switch: '<S27>/Switch' */ |
| 10230 | |
| 10231 | /* DataTypeConversion: '<S27>/Data Type Conversion1' */ |
| 10232 | tmp = (real32_T)floor(fusionAlg_B.Selector26_a.DynProp); |
| 10233 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10234 | tmp = 0.0F; |
| 10235 | } else { |
| 10236 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10237 | } |
| 10238 | |
| 10239 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objMotionPattern = (uint8_T) |
| 10240 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10241 | tmp); |
| 10242 | |
| 10243 | /* End of DataTypeConversion: '<S27>/Data Type Conversion1' */ |
| 10244 | |
| 10245 | /* BusCreator: '<S27>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10246 | * Constant: '<S27>/Constant' |
| 10247 | * Constant: '<S27>/Constant1' |
| 10248 | */ |
| 10249 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.reserved.reserved1 = |
| 10250 | fusionAlg_P_g.Constant_Value_gm; |
| 10251 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.reserved.reserved0 = |
| 10252 | fusionAlg_P_g.Constant1_Value_gb; |
| 10253 | |
| 10254 | /* BusCreator: '<S27>/Bus Creator1' incorporates: |
| 10255 | * Constant: '<S27>/Constant10' |
| 10256 | * Constant: '<S27>/Constant2' |
| 10257 | * Constant: '<S27>/Constant3' |
| 10258 | * Constant: '<S27>/Constant4' |
| 10259 | * Constant: '<S27>/Constant5' |
| 10260 | * Constant: '<S27>/Constant6' |
| 10261 | * Constant: '<S27>/Constant9' |
| 10262 | */ |
| 10263 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objObstacleProb = |
| 10264 | fusionAlg_B.Selector26_a.RCS; |
| 10265 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objXPos_Stdev = |
| 10266 | fusionAlg_P_g.Constant2_Value_hy; |
| 10267 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objYPos_Stdev = |
| 10268 | fusionAlg_P_g.Constant3_Value_c; |
| 10269 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objXVelRel_Stdev = |
| 10270 | fusionAlg_P_g.Constant4_Value_ai; |
| 10271 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objXAccRel = |
| 10272 | fusionAlg_P_g.Constant5_Value_gs; |
| 10273 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objExstProb = |
| 10274 | fusionAlg_P_g.Constant6_Value_j; |
| 10275 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objYVelRel = |
| 10276 | fusionAlg_B.Selector26_a.VrelLat; |
| 10277 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objXVelRel = |
| 10278 | fusionAlg_B.Selector26_a.VrelLong; |
| 10279 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objXPos = |
| 10280 | fusionAlg_B.Selector26_a.DistLong; |
| 10281 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objYPos = |
| 10282 | fusionAlg_B.Selector26_a.DistLat; |
| 10283 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objID = |
| 10284 | fusionAlg_B.DataTypeConversion_jw; |
| 10285 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objUpdateFlag = |
| 10286 | fusionAlg_B.Switch_o; |
| 10287 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objValidFlag = |
| 10288 | fusionAlg_B.Switch_o; |
| 10289 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objType = |
| 10290 | fusionAlg_P_g.Constant9_Value_f5; |
| 10291 | fusionAlg_B.BusCreator_i.radarObj.radar_20_obj.objMeasFlag = |
| 10292 | fusionAlg_P_g.Constant10_Value_ej; |
| 10293 | |
| 10294 | /* Selector: '<S13>/Selector27' incorporates: |
| 10295 | * Constant: '<S13>/Constant20' |
| 10296 | */ |
| 10297 | fusionAlg_B.Selector27_o = rtu_Radar308_Info_st-> |
| 10298 | leftFrontRadar_General[fusionAlg_P_g.Constant20_Value]; |
| 10299 | |
| 10300 | /* DataTypeConversion: '<S28>/Data Type Conversion' */ |
| 10301 | tmp = (real32_T)floor(fusionAlg_B.Selector27_o.ID); |
| 10302 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10303 | tmp = 0.0F; |
| 10304 | } else { |
| 10305 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10306 | } |
| 10307 | |
| 10308 | fusionAlg_B.DataTypeConversion_nz = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 10309 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10310 | |
| 10311 | /* End of DataTypeConversion: '<S28>/Data Type Conversion' */ |
| 10312 | |
| 10313 | /* Switch: '<S28>/Switch' incorporates: |
| 10314 | * Constant: '<S28>/Constant7' |
| 10315 | * Constant: '<S28>/Constant8' |
| 10316 | */ |
| 10317 | if (fusionAlg_B.DataTypeConversion_nz > fusionAlg_P_g.Switch_Threshold_ge) { |
| 10318 | fusionAlg_B.Switch_cn = fusionAlg_P_g.Constant7_Value_h2; |
| 10319 | } else { |
| 10320 | fusionAlg_B.Switch_cn = fusionAlg_P_g.Constant8_Value_fqf; |
| 10321 | } |
| 10322 | |
| 10323 | /* End of Switch: '<S28>/Switch' */ |
| 10324 | |
| 10325 | /* DataTypeConversion: '<S28>/Data Type Conversion1' */ |
| 10326 | tmp = (real32_T)floor(fusionAlg_B.Selector27_o.DynProp); |
| 10327 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10328 | tmp = 0.0F; |
| 10329 | } else { |
| 10330 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10331 | } |
| 10332 | |
| 10333 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objMotionPattern = (uint8_T) |
| 10334 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10335 | tmp); |
| 10336 | |
| 10337 | /* End of DataTypeConversion: '<S28>/Data Type Conversion1' */ |
| 10338 | |
| 10339 | /* BusCreator: '<S28>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10340 | * Constant: '<S28>/Constant' |
| 10341 | * Constant: '<S28>/Constant1' |
| 10342 | */ |
| 10343 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.reserved.reserved1 = |
| 10344 | fusionAlg_P_g.Constant_Value_ao; |
| 10345 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.reserved.reserved0 = |
| 10346 | fusionAlg_P_g.Constant1_Value_b2m; |
| 10347 | |
| 10348 | /* BusCreator: '<S28>/Bus Creator1' incorporates: |
| 10349 | * Constant: '<S28>/Constant10' |
| 10350 | * Constant: '<S28>/Constant2' |
| 10351 | * Constant: '<S28>/Constant3' |
| 10352 | * Constant: '<S28>/Constant4' |
| 10353 | * Constant: '<S28>/Constant5' |
| 10354 | * Constant: '<S28>/Constant6' |
| 10355 | * Constant: '<S28>/Constant9' |
| 10356 | */ |
| 10357 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objObstacleProb = |
| 10358 | fusionAlg_B.Selector27_o.RCS; |
| 10359 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objXPos_Stdev = |
| 10360 | fusionAlg_P_g.Constant2_Value_od; |
| 10361 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objYPos_Stdev = |
| 10362 | fusionAlg_P_g.Constant3_Value_pn; |
| 10363 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objXVelRel_Stdev = |
| 10364 | fusionAlg_P_g.Constant4_Value_pd; |
| 10365 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objXAccRel = |
| 10366 | fusionAlg_P_g.Constant5_Value_ej; |
| 10367 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objExstProb = |
| 10368 | fusionAlg_P_g.Constant6_Value_hz; |
| 10369 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objYVelRel = |
| 10370 | fusionAlg_B.Selector27_o.VrelLat; |
| 10371 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objXVelRel = |
| 10372 | fusionAlg_B.Selector27_o.VrelLong; |
| 10373 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objXPos = |
| 10374 | fusionAlg_B.Selector27_o.DistLong; |
| 10375 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objYPos = |
| 10376 | fusionAlg_B.Selector27_o.DistLat; |
| 10377 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objID = |
| 10378 | fusionAlg_B.DataTypeConversion_nz; |
| 10379 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objUpdateFlag = |
| 10380 | fusionAlg_B.Switch_cn; |
| 10381 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objValidFlag = |
| 10382 | fusionAlg_B.Switch_cn; |
| 10383 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objType = |
| 10384 | fusionAlg_P_g.Constant9_Value_au; |
| 10385 | fusionAlg_B.BusCreator_i.radarObj.radar_21_obj.objMeasFlag = |
| 10386 | fusionAlg_P_g.Constant10_Value_pq; |
| 10387 | |
| 10388 | /* Selector: '<S13>/Selector28' incorporates: |
| 10389 | * Constant: '<S13>/Constant21' |
| 10390 | */ |
| 10391 | fusionAlg_B.Selector28_j = rtu_Radar308_Info_st-> |
| 10392 | leftFrontRadar_General[fusionAlg_P_g.Constant21_Value]; |
| 10393 | |
| 10394 | /* DataTypeConversion: '<S29>/Data Type Conversion' */ |
| 10395 | tmp = (real32_T)floor(fusionAlg_B.Selector28_j.ID); |
| 10396 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10397 | tmp = 0.0F; |
| 10398 | } else { |
| 10399 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10400 | } |
| 10401 | |
| 10402 | fusionAlg_B.DataTypeConversion_fb = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 10403 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10404 | |
| 10405 | /* End of DataTypeConversion: '<S29>/Data Type Conversion' */ |
| 10406 | |
| 10407 | /* Switch: '<S29>/Switch' incorporates: |
| 10408 | * Constant: '<S29>/Constant7' |
| 10409 | * Constant: '<S29>/Constant8' |
| 10410 | */ |
| 10411 | if (fusionAlg_B.DataTypeConversion_fb > fusionAlg_P_g.Switch_Threshold_dp) { |
| 10412 | fusionAlg_B.Switch_fb = fusionAlg_P_g.Constant7_Value_md; |
| 10413 | } else { |
| 10414 | fusionAlg_B.Switch_fb = fusionAlg_P_g.Constant8_Value_a; |
| 10415 | } |
| 10416 | |
| 10417 | /* End of Switch: '<S29>/Switch' */ |
| 10418 | |
| 10419 | /* DataTypeConversion: '<S29>/Data Type Conversion1' */ |
| 10420 | tmp = (real32_T)floor(fusionAlg_B.Selector28_j.DynProp); |
| 10421 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10422 | tmp = 0.0F; |
| 10423 | } else { |
| 10424 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10425 | } |
| 10426 | |
| 10427 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objMotionPattern = (uint8_T) |
| 10428 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10429 | tmp); |
| 10430 | |
| 10431 | /* End of DataTypeConversion: '<S29>/Data Type Conversion1' */ |
| 10432 | |
| 10433 | /* BusCreator: '<S29>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10434 | * Constant: '<S29>/Constant' |
| 10435 | * Constant: '<S29>/Constant1' |
| 10436 | */ |
| 10437 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.reserved.reserved1 = |
| 10438 | fusionAlg_P_g.Constant_Value_g0o; |
| 10439 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.reserved.reserved0 = |
| 10440 | fusionAlg_P_g.Constant1_Value_g0; |
| 10441 | |
| 10442 | /* BusCreator: '<S29>/Bus Creator1' incorporates: |
| 10443 | * Constant: '<S29>/Constant10' |
| 10444 | * Constant: '<S29>/Constant2' |
| 10445 | * Constant: '<S29>/Constant3' |
| 10446 | * Constant: '<S29>/Constant4' |
| 10447 | * Constant: '<S29>/Constant5' |
| 10448 | * Constant: '<S29>/Constant6' |
| 10449 | * Constant: '<S29>/Constant9' |
| 10450 | */ |
| 10451 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objObstacleProb = |
| 10452 | fusionAlg_B.Selector28_j.RCS; |
| 10453 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objXPos_Stdev = |
| 10454 | fusionAlg_P_g.Constant2_Value_pp; |
| 10455 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objYPos_Stdev = |
| 10456 | fusionAlg_P_g.Constant3_Value_o; |
| 10457 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objXVelRel_Stdev = |
| 10458 | fusionAlg_P_g.Constant4_Value_pw; |
| 10459 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objXAccRel = |
| 10460 | fusionAlg_P_g.Constant5_Value_j; |
| 10461 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objExstProb = |
| 10462 | fusionAlg_P_g.Constant6_Value_px; |
| 10463 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objYVelRel = |
| 10464 | fusionAlg_B.Selector28_j.VrelLat; |
| 10465 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objXVelRel = |
| 10466 | fusionAlg_B.Selector28_j.VrelLong; |
| 10467 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objXPos = |
| 10468 | fusionAlg_B.Selector28_j.DistLong; |
| 10469 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objYPos = |
| 10470 | fusionAlg_B.Selector28_j.DistLat; |
| 10471 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objID = |
| 10472 | fusionAlg_B.DataTypeConversion_fb; |
| 10473 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objUpdateFlag = |
| 10474 | fusionAlg_B.Switch_fb; |
| 10475 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objValidFlag = |
| 10476 | fusionAlg_B.Switch_fb; |
| 10477 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objType = |
| 10478 | fusionAlg_P_g.Constant9_Value_pk; |
| 10479 | fusionAlg_B.BusCreator_i.radarObj.radar_22_obj.objMeasFlag = |
| 10480 | fusionAlg_P_g.Constant10_Value_lk; |
| 10481 | |
| 10482 | /* Selector: '<S13>/Selector29' incorporates: |
| 10483 | * Constant: '<S13>/Constant22' |
| 10484 | */ |
| 10485 | fusionAlg_B.Selector29_m = rtu_Radar308_Info_st-> |
| 10486 | leftFrontRadar_General[fusionAlg_P_g.Constant22_Value]; |
| 10487 | |
| 10488 | /* DataTypeConversion: '<S30>/Data Type Conversion' */ |
| 10489 | tmp = (real32_T)floor(fusionAlg_B.Selector29_m.ID); |
| 10490 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10491 | tmp = 0.0F; |
| 10492 | } else { |
| 10493 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10494 | } |
| 10495 | |
| 10496 | fusionAlg_B.DataTypeConversion_p0 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 10497 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10498 | |
| 10499 | /* End of DataTypeConversion: '<S30>/Data Type Conversion' */ |
| 10500 | |
| 10501 | /* Switch: '<S30>/Switch' incorporates: |
| 10502 | * Constant: '<S30>/Constant7' |
| 10503 | * Constant: '<S30>/Constant8' |
| 10504 | */ |
| 10505 | if (fusionAlg_B.DataTypeConversion_p0 > fusionAlg_P_g.Switch_Threshold_hq) { |
| 10506 | fusionAlg_B.Switch_pv = fusionAlg_P_g.Constant7_Value_o; |
| 10507 | } else { |
| 10508 | fusionAlg_B.Switch_pv = fusionAlg_P_g.Constant8_Value_g1; |
| 10509 | } |
| 10510 | |
| 10511 | /* End of Switch: '<S30>/Switch' */ |
| 10512 | |
| 10513 | /* DataTypeConversion: '<S30>/Data Type Conversion1' */ |
| 10514 | tmp = (real32_T)floor(fusionAlg_B.Selector29_m.DynProp); |
| 10515 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10516 | tmp = 0.0F; |
| 10517 | } else { |
| 10518 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10519 | } |
| 10520 | |
| 10521 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objMotionPattern = (uint8_T) |
| 10522 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10523 | tmp); |
| 10524 | |
| 10525 | /* End of DataTypeConversion: '<S30>/Data Type Conversion1' */ |
| 10526 | |
| 10527 | /* BusCreator: '<S30>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10528 | * Constant: '<S30>/Constant' |
| 10529 | * Constant: '<S30>/Constant1' |
| 10530 | */ |
| 10531 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.reserved.reserved1 = |
| 10532 | fusionAlg_P_g.Constant_Value_c0; |
| 10533 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.reserved.reserved0 = |
| 10534 | fusionAlg_P_g.Constant1_Value_lhs; |
| 10535 | |
| 10536 | /* BusCreator: '<S30>/Bus Creator1' incorporates: |
| 10537 | * Constant: '<S30>/Constant10' |
| 10538 | * Constant: '<S30>/Constant2' |
| 10539 | * Constant: '<S30>/Constant3' |
| 10540 | * Constant: '<S30>/Constant4' |
| 10541 | * Constant: '<S30>/Constant5' |
| 10542 | * Constant: '<S30>/Constant6' |
| 10543 | * Constant: '<S30>/Constant9' |
| 10544 | */ |
| 10545 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objObstacleProb = |
| 10546 | fusionAlg_B.Selector29_m.RCS; |
| 10547 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objXPos_Stdev = |
| 10548 | fusionAlg_P_g.Constant2_Value_kv; |
| 10549 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objYPos_Stdev = |
| 10550 | fusionAlg_P_g.Constant3_Value_cj; |
| 10551 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objXVelRel_Stdev = |
| 10552 | fusionAlg_P_g.Constant4_Value_ip; |
| 10553 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objXAccRel = |
| 10554 | fusionAlg_P_g.Constant5_Value_c0; |
| 10555 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objExstProb = |
| 10556 | fusionAlg_P_g.Constant6_Value_ls; |
| 10557 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objYVelRel = |
| 10558 | fusionAlg_B.Selector29_m.VrelLat; |
| 10559 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objXVelRel = |
| 10560 | fusionAlg_B.Selector29_m.VrelLong; |
| 10561 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objXPos = |
| 10562 | fusionAlg_B.Selector29_m.DistLong; |
| 10563 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objYPos = |
| 10564 | fusionAlg_B.Selector29_m.DistLat; |
| 10565 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objID = |
| 10566 | fusionAlg_B.DataTypeConversion_p0; |
| 10567 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objUpdateFlag = |
| 10568 | fusionAlg_B.Switch_pv; |
| 10569 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objValidFlag = |
| 10570 | fusionAlg_B.Switch_pv; |
| 10571 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objType = |
| 10572 | fusionAlg_P_g.Constant9_Value_dr; |
| 10573 | fusionAlg_B.BusCreator_i.radarObj.radar_23_obj.objMeasFlag = |
| 10574 | fusionAlg_P_g.Constant10_Value_j5; |
| 10575 | |
| 10576 | /* Selector: '<S13>/Selector30' incorporates: |
| 10577 | * Constant: '<S13>/Constant23' |
| 10578 | */ |
| 10579 | fusionAlg_B.Selector30_o = rtu_Radar308_Info_st-> |
| 10580 | leftFrontRadar_General[fusionAlg_P_g.Constant23_Value]; |
| 10581 | |
| 10582 | /* DataTypeConversion: '<S31>/Data Type Conversion' */ |
| 10583 | tmp = (real32_T)floor(fusionAlg_B.Selector30_o.ID); |
| 10584 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10585 | tmp = 0.0F; |
| 10586 | } else { |
| 10587 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10588 | } |
| 10589 | |
| 10590 | fusionAlg_B.DataTypeConversion_eb = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 10591 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10592 | |
| 10593 | /* End of DataTypeConversion: '<S31>/Data Type Conversion' */ |
| 10594 | |
| 10595 | /* Switch: '<S31>/Switch' incorporates: |
| 10596 | * Constant: '<S31>/Constant7' |
| 10597 | * Constant: '<S31>/Constant8' |
| 10598 | */ |
| 10599 | if (fusionAlg_B.DataTypeConversion_eb > fusionAlg_P_g.Switch_Threshold_bj) { |
| 10600 | fusionAlg_B.Switch_nj = fusionAlg_P_g.Constant7_Value_pr; |
| 10601 | } else { |
| 10602 | fusionAlg_B.Switch_nj = fusionAlg_P_g.Constant8_Value_c0; |
| 10603 | } |
| 10604 | |
| 10605 | /* End of Switch: '<S31>/Switch' */ |
| 10606 | |
| 10607 | /* DataTypeConversion: '<S31>/Data Type Conversion1' */ |
| 10608 | tmp = (real32_T)floor(fusionAlg_B.Selector30_o.DynProp); |
| 10609 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10610 | tmp = 0.0F; |
| 10611 | } else { |
| 10612 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10613 | } |
| 10614 | |
| 10615 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objMotionPattern = (uint8_T) |
| 10616 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10617 | tmp); |
| 10618 | |
| 10619 | /* End of DataTypeConversion: '<S31>/Data Type Conversion1' */ |
| 10620 | |
| 10621 | /* BusCreator: '<S31>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10622 | * Constant: '<S31>/Constant' |
| 10623 | * Constant: '<S31>/Constant1' |
| 10624 | */ |
| 10625 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.reserved.reserved1 = |
| 10626 | fusionAlg_P_g.Constant_Value_jm; |
| 10627 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.reserved.reserved0 = |
| 10628 | fusionAlg_P_g.Constant1_Value_gj; |
| 10629 | |
| 10630 | /* BusCreator: '<S31>/Bus Creator1' incorporates: |
| 10631 | * Constant: '<S31>/Constant10' |
| 10632 | * Constant: '<S31>/Constant2' |
| 10633 | * Constant: '<S31>/Constant3' |
| 10634 | * Constant: '<S31>/Constant4' |
| 10635 | * Constant: '<S31>/Constant5' |
| 10636 | * Constant: '<S31>/Constant6' |
| 10637 | * Constant: '<S31>/Constant9' |
| 10638 | */ |
| 10639 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objObstacleProb = |
| 10640 | fusionAlg_B.Selector30_o.RCS; |
| 10641 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objXPos_Stdev = |
| 10642 | fusionAlg_P_g.Constant2_Value_dc; |
| 10643 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objYPos_Stdev = |
| 10644 | fusionAlg_P_g.Constant3_Value_cu; |
| 10645 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objXVelRel_Stdev = |
| 10646 | fusionAlg_P_g.Constant4_Value_du; |
| 10647 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objXAccRel = |
| 10648 | fusionAlg_P_g.Constant5_Value_k; |
| 10649 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objExstProb = |
| 10650 | fusionAlg_P_g.Constant6_Value_n; |
| 10651 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objYVelRel = |
| 10652 | fusionAlg_B.Selector30_o.VrelLat; |
| 10653 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objXVelRel = |
| 10654 | fusionAlg_B.Selector30_o.VrelLong; |
| 10655 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objXPos = |
| 10656 | fusionAlg_B.Selector30_o.DistLong; |
| 10657 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objYPos = |
| 10658 | fusionAlg_B.Selector30_o.DistLat; |
| 10659 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objID = |
| 10660 | fusionAlg_B.DataTypeConversion_eb; |
| 10661 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objUpdateFlag = |
| 10662 | fusionAlg_B.Switch_nj; |
| 10663 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objValidFlag = |
| 10664 | fusionAlg_B.Switch_nj; |
| 10665 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objType = |
| 10666 | fusionAlg_P_g.Constant9_Value_l; |
| 10667 | fusionAlg_B.BusCreator_i.radarObj.radar_24_obj.objMeasFlag = |
| 10668 | fusionAlg_P_g.Constant10_Value_ds; |
| 10669 | |
| 10670 | /* Selector: '<S13>/Selector17' incorporates: |
| 10671 | * Constant: '<S13>/Constant24' |
| 10672 | */ |
| 10673 | fusionAlg_B.Selector17_o = rtu_Radar308_Info_st-> |
| 10674 | leftFrontRadar_General[fusionAlg_P_g.Constant24_Value]; |
| 10675 | |
| 10676 | /* DataTypeConversion: '<S32>/Data Type Conversion' */ |
| 10677 | tmp = (real32_T)floor(fusionAlg_B.Selector17_o.ID); |
| 10678 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10679 | tmp = 0.0F; |
| 10680 | } else { |
| 10681 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10682 | } |
| 10683 | |
| 10684 | fusionAlg_B.DataTypeConversion_au = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 10685 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10686 | |
| 10687 | /* End of DataTypeConversion: '<S32>/Data Type Conversion' */ |
| 10688 | |
| 10689 | /* Switch: '<S32>/Switch' incorporates: |
| 10690 | * Constant: '<S32>/Constant7' |
| 10691 | * Constant: '<S32>/Constant8' |
| 10692 | */ |
| 10693 | if (fusionAlg_B.DataTypeConversion_au > fusionAlg_P_g.Switch_Threshold_bc) { |
| 10694 | fusionAlg_B.Switch_c2 = fusionAlg_P_g.Constant7_Value_pf; |
| 10695 | } else { |
| 10696 | fusionAlg_B.Switch_c2 = fusionAlg_P_g.Constant8_Value_op; |
| 10697 | } |
| 10698 | |
| 10699 | /* End of Switch: '<S32>/Switch' */ |
| 10700 | |
| 10701 | /* DataTypeConversion: '<S32>/Data Type Conversion1' */ |
| 10702 | tmp = (real32_T)floor(fusionAlg_B.Selector17_o.DynProp); |
| 10703 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10704 | tmp = 0.0F; |
| 10705 | } else { |
| 10706 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10707 | } |
| 10708 | |
| 10709 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objMotionPattern = (uint8_T) |
| 10710 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10711 | tmp); |
| 10712 | |
| 10713 | /* End of DataTypeConversion: '<S32>/Data Type Conversion1' */ |
| 10714 | |
| 10715 | /* BusCreator: '<S32>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10716 | * Constant: '<S32>/Constant' |
| 10717 | * Constant: '<S32>/Constant1' |
| 10718 | */ |
| 10719 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.reserved.reserved1 = |
| 10720 | fusionAlg_P_g.Constant_Value_dyn; |
| 10721 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.reserved.reserved0 = |
| 10722 | fusionAlg_P_g.Constant1_Value_cq; |
| 10723 | |
| 10724 | /* BusCreator: '<S32>/Bus Creator1' incorporates: |
| 10725 | * Constant: '<S32>/Constant10' |
| 10726 | * Constant: '<S32>/Constant2' |
| 10727 | * Constant: '<S32>/Constant3' |
| 10728 | * Constant: '<S32>/Constant4' |
| 10729 | * Constant: '<S32>/Constant5' |
| 10730 | * Constant: '<S32>/Constant6' |
| 10731 | * Constant: '<S32>/Constant9' |
| 10732 | */ |
| 10733 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objObstacleProb = |
| 10734 | fusionAlg_B.Selector17_o.RCS; |
| 10735 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objXPos_Stdev = |
| 10736 | fusionAlg_P_g.Constant2_Value_m3; |
| 10737 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objYPos_Stdev = |
| 10738 | fusionAlg_P_g.Constant3_Value_f3; |
| 10739 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objXVelRel_Stdev = |
| 10740 | fusionAlg_P_g.Constant4_Value_pn; |
| 10741 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objXAccRel = |
| 10742 | fusionAlg_P_g.Constant5_Value_i; |
| 10743 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objExstProb = |
| 10744 | fusionAlg_P_g.Constant6_Value_ev; |
| 10745 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objYVelRel = |
| 10746 | fusionAlg_B.Selector17_o.VrelLat; |
| 10747 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objXVelRel = |
| 10748 | fusionAlg_B.Selector17_o.VrelLong; |
| 10749 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objXPos = |
| 10750 | fusionAlg_B.Selector17_o.DistLong; |
| 10751 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objYPos = |
| 10752 | fusionAlg_B.Selector17_o.DistLat; |
| 10753 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objID = |
| 10754 | fusionAlg_B.DataTypeConversion_au; |
| 10755 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objUpdateFlag = |
| 10756 | fusionAlg_B.Switch_c2; |
| 10757 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objValidFlag = |
| 10758 | fusionAlg_B.Switch_c2; |
| 10759 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objType = |
| 10760 | fusionAlg_P_g.Constant9_Value_dj; |
| 10761 | fusionAlg_B.BusCreator_i.radarObj.radar_25_obj.objMeasFlag = |
| 10762 | fusionAlg_P_g.Constant10_Value_d3; |
| 10763 | |
| 10764 | /* Selector: '<S13>/Selector18' incorporates: |
| 10765 | * Constant: '<S13>/Constant25' |
| 10766 | */ |
| 10767 | fusionAlg_B.Selector18_k = rtu_Radar308_Info_st-> |
| 10768 | leftFrontRadar_General[fusionAlg_P_g.Constant25_Value]; |
| 10769 | |
| 10770 | /* DataTypeConversion: '<S33>/Data Type Conversion' */ |
| 10771 | tmp = (real32_T)floor(fusionAlg_B.Selector18_k.ID); |
| 10772 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10773 | tmp = 0.0F; |
| 10774 | } else { |
| 10775 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10776 | } |
| 10777 | |
| 10778 | fusionAlg_B.DataTypeConversion_lm = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 10779 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10780 | |
| 10781 | /* End of DataTypeConversion: '<S33>/Data Type Conversion' */ |
| 10782 | |
| 10783 | /* Switch: '<S33>/Switch' incorporates: |
| 10784 | * Constant: '<S33>/Constant7' |
| 10785 | * Constant: '<S33>/Constant8' |
| 10786 | */ |
| 10787 | if (fusionAlg_B.DataTypeConversion_lm > fusionAlg_P_g.Switch_Threshold_nz) { |
| 10788 | fusionAlg_B.Switch_j = fusionAlg_P_g.Constant7_Value_cw; |
| 10789 | } else { |
| 10790 | fusionAlg_B.Switch_j = fusionAlg_P_g.Constant8_Value_bj; |
| 10791 | } |
| 10792 | |
| 10793 | /* End of Switch: '<S33>/Switch' */ |
| 10794 | |
| 10795 | /* DataTypeConversion: '<S33>/Data Type Conversion1' */ |
| 10796 | tmp = (real32_T)floor(fusionAlg_B.Selector18_k.DynProp); |
| 10797 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10798 | tmp = 0.0F; |
| 10799 | } else { |
| 10800 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10801 | } |
| 10802 | |
| 10803 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objMotionPattern = (uint8_T) |
| 10804 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10805 | tmp); |
| 10806 | |
| 10807 | /* End of DataTypeConversion: '<S33>/Data Type Conversion1' */ |
| 10808 | |
| 10809 | /* BusCreator: '<S33>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10810 | * Constant: '<S33>/Constant' |
| 10811 | * Constant: '<S33>/Constant1' |
| 10812 | */ |
| 10813 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.reserved.reserved1 = |
| 10814 | fusionAlg_P_g.Constant_Value_lx; |
| 10815 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.reserved.reserved0 = |
| 10816 | fusionAlg_P_g.Constant1_Value_bzo; |
| 10817 | |
| 10818 | /* BusCreator: '<S33>/Bus Creator1' incorporates: |
| 10819 | * Constant: '<S33>/Constant10' |
| 10820 | * Constant: '<S33>/Constant2' |
| 10821 | * Constant: '<S33>/Constant3' |
| 10822 | * Constant: '<S33>/Constant4' |
| 10823 | * Constant: '<S33>/Constant5' |
| 10824 | * Constant: '<S33>/Constant6' |
| 10825 | * Constant: '<S33>/Constant9' |
| 10826 | */ |
| 10827 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objObstacleProb = |
| 10828 | fusionAlg_B.Selector18_k.RCS; |
| 10829 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objXPos_Stdev = |
| 10830 | fusionAlg_P_g.Constant2_Value_p0; |
| 10831 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objYPos_Stdev = |
| 10832 | fusionAlg_P_g.Constant3_Value_a2; |
| 10833 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objXVelRel_Stdev = |
| 10834 | fusionAlg_P_g.Constant4_Value_ivr; |
| 10835 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objXAccRel = |
| 10836 | fusionAlg_P_g.Constant5_Value_d; |
| 10837 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objExstProb = |
| 10838 | fusionAlg_P_g.Constant6_Value_o; |
| 10839 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objYVelRel = |
| 10840 | fusionAlg_B.Selector18_k.VrelLat; |
| 10841 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objXVelRel = |
| 10842 | fusionAlg_B.Selector18_k.VrelLong; |
| 10843 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objXPos = |
| 10844 | fusionAlg_B.Selector18_k.DistLong; |
| 10845 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objYPos = |
| 10846 | fusionAlg_B.Selector18_k.DistLat; |
| 10847 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objID = |
| 10848 | fusionAlg_B.DataTypeConversion_lm; |
| 10849 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objUpdateFlag = |
| 10850 | fusionAlg_B.Switch_j; |
| 10851 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objValidFlag = |
| 10852 | fusionAlg_B.Switch_j; |
| 10853 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objType = |
| 10854 | fusionAlg_P_g.Constant9_Value_al; |
| 10855 | fusionAlg_B.BusCreator_i.radarObj.radar_26_obj.objMeasFlag = |
| 10856 | fusionAlg_P_g.Constant10_Value_lp; |
| 10857 | |
| 10858 | /* Selector: '<S13>/Selector19' incorporates: |
| 10859 | * Constant: '<S13>/Constant26' |
| 10860 | */ |
| 10861 | fusionAlg_B.Selector19_b = rtu_Radar308_Info_st-> |
| 10862 | leftFrontRadar_General[fusionAlg_P_g.Constant26_Value]; |
| 10863 | |
| 10864 | /* DataTypeConversion: '<S34>/Data Type Conversion' */ |
| 10865 | tmp = (real32_T)floor(fusionAlg_B.Selector19_b.ID); |
| 10866 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10867 | tmp = 0.0F; |
| 10868 | } else { |
| 10869 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10870 | } |
| 10871 | |
| 10872 | fusionAlg_B.DataTypeConversion_hh = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 10873 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10874 | |
| 10875 | /* End of DataTypeConversion: '<S34>/Data Type Conversion' */ |
| 10876 | |
| 10877 | /* Switch: '<S34>/Switch' incorporates: |
| 10878 | * Constant: '<S34>/Constant7' |
| 10879 | * Constant: '<S34>/Constant8' |
| 10880 | */ |
| 10881 | if (fusionAlg_B.DataTypeConversion_hh > fusionAlg_P_g.Switch_Threshold_ow) { |
| 10882 | fusionAlg_B.Switch_jh = fusionAlg_P_g.Constant7_Value_f3; |
| 10883 | } else { |
| 10884 | fusionAlg_B.Switch_jh = fusionAlg_P_g.Constant8_Value_of; |
| 10885 | } |
| 10886 | |
| 10887 | /* End of Switch: '<S34>/Switch' */ |
| 10888 | |
| 10889 | /* DataTypeConversion: '<S34>/Data Type Conversion1' */ |
| 10890 | tmp = (real32_T)floor(fusionAlg_B.Selector19_b.DynProp); |
| 10891 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10892 | tmp = 0.0F; |
| 10893 | } else { |
| 10894 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10895 | } |
| 10896 | |
| 10897 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objMotionPattern = (uint8_T) |
| 10898 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10899 | tmp); |
| 10900 | |
| 10901 | /* End of DataTypeConversion: '<S34>/Data Type Conversion1' */ |
| 10902 | |
| 10903 | /* BusCreator: '<S34>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10904 | * Constant: '<S34>/Constant' |
| 10905 | * Constant: '<S34>/Constant1' |
| 10906 | */ |
| 10907 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.reserved.reserved1 = |
| 10908 | fusionAlg_P_g.Constant_Value_gmg; |
| 10909 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.reserved.reserved0 = |
| 10910 | fusionAlg_P_g.Constant1_Value_hw; |
| 10911 | |
| 10912 | /* BusCreator: '<S34>/Bus Creator1' incorporates: |
| 10913 | * Constant: '<S34>/Constant10' |
| 10914 | * Constant: '<S34>/Constant2' |
| 10915 | * Constant: '<S34>/Constant3' |
| 10916 | * Constant: '<S34>/Constant4' |
| 10917 | * Constant: '<S34>/Constant5' |
| 10918 | * Constant: '<S34>/Constant6' |
| 10919 | * Constant: '<S34>/Constant9' |
| 10920 | */ |
| 10921 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objObstacleProb = |
| 10922 | fusionAlg_B.Selector19_b.RCS; |
| 10923 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objXPos_Stdev = |
| 10924 | fusionAlg_P_g.Constant2_Value_ap; |
| 10925 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objYPos_Stdev = |
| 10926 | fusionAlg_P_g.Constant3_Value_jg; |
| 10927 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objXVelRel_Stdev = |
| 10928 | fusionAlg_P_g.Constant4_Value_k; |
| 10929 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objXAccRel = |
| 10930 | fusionAlg_P_g.Constant5_Value_p; |
| 10931 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objExstProb = |
| 10932 | fusionAlg_P_g.Constant6_Value_dr; |
| 10933 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objYVelRel = |
| 10934 | fusionAlg_B.Selector19_b.VrelLat; |
| 10935 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objXVelRel = |
| 10936 | fusionAlg_B.Selector19_b.VrelLong; |
| 10937 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objXPos = |
| 10938 | fusionAlg_B.Selector19_b.DistLong; |
| 10939 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objYPos = |
| 10940 | fusionAlg_B.Selector19_b.DistLat; |
| 10941 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objID = |
| 10942 | fusionAlg_B.DataTypeConversion_hh; |
| 10943 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objUpdateFlag = |
| 10944 | fusionAlg_B.Switch_jh; |
| 10945 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objValidFlag = |
| 10946 | fusionAlg_B.Switch_jh; |
| 10947 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objType = |
| 10948 | fusionAlg_P_g.Constant9_Value_pn; |
| 10949 | fusionAlg_B.BusCreator_i.radarObj.radar_27_obj.objMeasFlag = |
| 10950 | fusionAlg_P_g.Constant10_Value_f; |
| 10951 | |
| 10952 | /* Selector: '<S13>/Selector20' incorporates: |
| 10953 | * Constant: '<S13>/Constant27' |
| 10954 | */ |
| 10955 | fusionAlg_B.Selector20_h = rtu_Radar308_Info_st-> |
| 10956 | leftFrontRadar_General[fusionAlg_P_g.Constant27_Value]; |
| 10957 | |
| 10958 | /* DataTypeConversion: '<S35>/Data Type Conversion' */ |
| 10959 | tmp = (real32_T)floor(fusionAlg_B.Selector20_h.ID); |
| 10960 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10961 | tmp = 0.0F; |
| 10962 | } else { |
| 10963 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 10964 | } |
| 10965 | |
| 10966 | fusionAlg_B.DataTypeConversion_pl = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 10967 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 10968 | |
| 10969 | /* End of DataTypeConversion: '<S35>/Data Type Conversion' */ |
| 10970 | |
| 10971 | /* Switch: '<S35>/Switch' incorporates: |
| 10972 | * Constant: '<S35>/Constant7' |
| 10973 | * Constant: '<S35>/Constant8' |
| 10974 | */ |
| 10975 | if (fusionAlg_B.DataTypeConversion_pl > fusionAlg_P_g.Switch_Threshold_e) { |
| 10976 | fusionAlg_B.Switch_fk = fusionAlg_P_g.Constant7_Value_fq; |
| 10977 | } else { |
| 10978 | fusionAlg_B.Switch_fk = fusionAlg_P_g.Constant8_Value_kz; |
| 10979 | } |
| 10980 | |
| 10981 | /* End of Switch: '<S35>/Switch' */ |
| 10982 | |
| 10983 | /* DataTypeConversion: '<S35>/Data Type Conversion1' */ |
| 10984 | tmp = (real32_T)floor(fusionAlg_B.Selector20_h.DynProp); |
| 10985 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 10986 | tmp = 0.0F; |
| 10987 | } else { |
| 10988 | tmp = (real32_T)fmod(tmp, 256.0); |
| 10989 | } |
| 10990 | |
| 10991 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objMotionPattern = (uint8_T) |
| 10992 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 10993 | tmp); |
| 10994 | |
| 10995 | /* End of DataTypeConversion: '<S35>/Data Type Conversion1' */ |
| 10996 | |
| 10997 | /* BusCreator: '<S35>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 10998 | * Constant: '<S35>/Constant' |
| 10999 | * Constant: '<S35>/Constant1' |
| 11000 | */ |
| 11001 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.reserved.reserved1 = |
| 11002 | fusionAlg_P_g.Constant_Value_aav; |
| 11003 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.reserved.reserved0 = |
| 11004 | fusionAlg_P_g.Constant1_Value_p1; |
| 11005 | |
| 11006 | /* BusCreator: '<S35>/Bus Creator1' incorporates: |
| 11007 | * Constant: '<S35>/Constant10' |
| 11008 | * Constant: '<S35>/Constant2' |
| 11009 | * Constant: '<S35>/Constant3' |
| 11010 | * Constant: '<S35>/Constant4' |
| 11011 | * Constant: '<S35>/Constant5' |
| 11012 | * Constant: '<S35>/Constant6' |
| 11013 | * Constant: '<S35>/Constant9' |
| 11014 | */ |
| 11015 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objObstacleProb = |
| 11016 | fusionAlg_B.Selector20_h.RCS; |
| 11017 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objXPos_Stdev = |
| 11018 | fusionAlg_P_g.Constant2_Value_hpr; |
| 11019 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objYPos_Stdev = |
| 11020 | fusionAlg_P_g.Constant3_Value_no; |
| 11021 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objXVelRel_Stdev = |
| 11022 | fusionAlg_P_g.Constant4_Value_k5; |
| 11023 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objXAccRel = |
| 11024 | fusionAlg_P_g.Constant5_Value_p3; |
| 11025 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objExstProb = |
| 11026 | fusionAlg_P_g.Constant6_Value_hq; |
| 11027 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objYVelRel = |
| 11028 | fusionAlg_B.Selector20_h.VrelLat; |
| 11029 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objXVelRel = |
| 11030 | fusionAlg_B.Selector20_h.VrelLong; |
| 11031 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objXPos = |
| 11032 | fusionAlg_B.Selector20_h.DistLong; |
| 11033 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objYPos = |
| 11034 | fusionAlg_B.Selector20_h.DistLat; |
| 11035 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objID = |
| 11036 | fusionAlg_B.DataTypeConversion_pl; |
| 11037 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objUpdateFlag = |
| 11038 | fusionAlg_B.Switch_fk; |
| 11039 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objValidFlag = |
| 11040 | fusionAlg_B.Switch_fk; |
| 11041 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objType = |
| 11042 | fusionAlg_P_g.Constant9_Value_e; |
| 11043 | fusionAlg_B.BusCreator_i.radarObj.radar_28_obj.objMeasFlag = |
| 11044 | fusionAlg_P_g.Constant10_Value_ml; |
| 11045 | |
| 11046 | /* Selector: '<S13>/Selector21' incorporates: |
| 11047 | * Constant: '<S13>/Constant28' |
| 11048 | */ |
| 11049 | fusionAlg_B.Selector21_h = rtu_Radar308_Info_st-> |
| 11050 | leftFrontRadar_General[fusionAlg_P_g.Constant28_Value]; |
| 11051 | |
| 11052 | /* DataTypeConversion: '<S36>/Data Type Conversion' */ |
| 11053 | tmp = (real32_T)floor(fusionAlg_B.Selector21_h.ID); |
| 11054 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11055 | tmp = 0.0F; |
| 11056 | } else { |
| 11057 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11058 | } |
| 11059 | |
| 11060 | fusionAlg_B.DataTypeConversion_mz = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11061 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11062 | |
| 11063 | /* End of DataTypeConversion: '<S36>/Data Type Conversion' */ |
| 11064 | |
| 11065 | /* Switch: '<S36>/Switch' incorporates: |
| 11066 | * Constant: '<S36>/Constant7' |
| 11067 | * Constant: '<S36>/Constant8' |
| 11068 | */ |
| 11069 | if (fusionAlg_B.DataTypeConversion_mz > fusionAlg_P_g.Switch_Threshold_j) { |
| 11070 | fusionAlg_B.Switch_nt = fusionAlg_P_g.Constant7_Value_ox; |
| 11071 | } else { |
| 11072 | fusionAlg_B.Switch_nt = fusionAlg_P_g.Constant8_Value_b2; |
| 11073 | } |
| 11074 | |
| 11075 | /* End of Switch: '<S36>/Switch' */ |
| 11076 | |
| 11077 | /* DataTypeConversion: '<S36>/Data Type Conversion1' */ |
| 11078 | tmp = (real32_T)floor(fusionAlg_B.Selector21_h.DynProp); |
| 11079 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11080 | tmp = 0.0F; |
| 11081 | } else { |
| 11082 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11083 | } |
| 11084 | |
| 11085 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objMotionPattern = (uint8_T) |
| 11086 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11087 | tmp); |
| 11088 | |
| 11089 | /* End of DataTypeConversion: '<S36>/Data Type Conversion1' */ |
| 11090 | |
| 11091 | /* BusCreator: '<S36>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11092 | * Constant: '<S36>/Constant' |
| 11093 | * Constant: '<S36>/Constant1' |
| 11094 | */ |
| 11095 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.reserved.reserved1 = |
| 11096 | fusionAlg_P_g.Constant_Value_jq; |
| 11097 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.reserved.reserved0 = |
| 11098 | fusionAlg_P_g.Constant1_Value_bx; |
| 11099 | |
| 11100 | /* BusCreator: '<S36>/Bus Creator1' incorporates: |
| 11101 | * Constant: '<S36>/Constant10' |
| 11102 | * Constant: '<S36>/Constant2' |
| 11103 | * Constant: '<S36>/Constant3' |
| 11104 | * Constant: '<S36>/Constant4' |
| 11105 | * Constant: '<S36>/Constant5' |
| 11106 | * Constant: '<S36>/Constant6' |
| 11107 | * Constant: '<S36>/Constant9' |
| 11108 | */ |
| 11109 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objObstacleProb = |
| 11110 | fusionAlg_B.Selector21_h.RCS; |
| 11111 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objXPos_Stdev = |
| 11112 | fusionAlg_P_g.Constant2_Value_fc; |
| 11113 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objYPos_Stdev = |
| 11114 | fusionAlg_P_g.Constant3_Value_az; |
| 11115 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objXVelRel_Stdev = |
| 11116 | fusionAlg_P_g.Constant4_Value_o4; |
| 11117 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objXAccRel = |
| 11118 | fusionAlg_P_g.Constant5_Value_a1; |
| 11119 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objExstProb = |
| 11120 | fusionAlg_P_g.Constant6_Value_pl; |
| 11121 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objYVelRel = |
| 11122 | fusionAlg_B.Selector21_h.VrelLat; |
| 11123 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objXVelRel = |
| 11124 | fusionAlg_B.Selector21_h.VrelLong; |
| 11125 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objXPos = |
| 11126 | fusionAlg_B.Selector21_h.DistLong; |
| 11127 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objYPos = |
| 11128 | fusionAlg_B.Selector21_h.DistLat; |
| 11129 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objID = |
| 11130 | fusionAlg_B.DataTypeConversion_mz; |
| 11131 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objUpdateFlag = |
| 11132 | fusionAlg_B.Switch_nt; |
| 11133 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objValidFlag = |
| 11134 | fusionAlg_B.Switch_nt; |
| 11135 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objType = |
| 11136 | fusionAlg_P_g.Constant9_Value_m; |
| 11137 | fusionAlg_B.BusCreator_i.radarObj.radar_29_obj.objMeasFlag = |
| 11138 | fusionAlg_P_g.Constant10_Value_k2; |
| 11139 | |
| 11140 | /* Selector: '<S13>/Selector22' incorporates: |
| 11141 | * Constant: '<S13>/Constant29' |
| 11142 | */ |
| 11143 | fusionAlg_B.Selector22_c = rtu_Radar308_Info_st-> |
| 11144 | leftFrontRadar_General[fusionAlg_P_g.Constant29_Value]; |
| 11145 | |
| 11146 | /* DataTypeConversion: '<S38>/Data Type Conversion' */ |
| 11147 | tmp = (real32_T)floor(fusionAlg_B.Selector22_c.ID); |
| 11148 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11149 | tmp = 0.0F; |
| 11150 | } else { |
| 11151 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11152 | } |
| 11153 | |
| 11154 | fusionAlg_B.DataTypeConversion_ic = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11155 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11156 | |
| 11157 | /* End of DataTypeConversion: '<S38>/Data Type Conversion' */ |
| 11158 | |
| 11159 | /* Switch: '<S38>/Switch' incorporates: |
| 11160 | * Constant: '<S38>/Constant7' |
| 11161 | * Constant: '<S38>/Constant8' |
| 11162 | */ |
| 11163 | if (fusionAlg_B.DataTypeConversion_ic > fusionAlg_P_g.Switch_Threshold_ll) { |
| 11164 | fusionAlg_B.Switch_kl = fusionAlg_P_g.Constant7_Value_pa; |
| 11165 | } else { |
| 11166 | fusionAlg_B.Switch_kl = fusionAlg_P_g.Constant8_Value_i; |
| 11167 | } |
| 11168 | |
| 11169 | /* End of Switch: '<S38>/Switch' */ |
| 11170 | |
| 11171 | /* DataTypeConversion: '<S38>/Data Type Conversion1' */ |
| 11172 | tmp = (real32_T)floor(fusionAlg_B.Selector22_c.DynProp); |
| 11173 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11174 | tmp = 0.0F; |
| 11175 | } else { |
| 11176 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11177 | } |
| 11178 | |
| 11179 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objMotionPattern = (uint8_T) |
| 11180 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11181 | tmp); |
| 11182 | |
| 11183 | /* End of DataTypeConversion: '<S38>/Data Type Conversion1' */ |
| 11184 | |
| 11185 | /* BusCreator: '<S38>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11186 | * Constant: '<S38>/Constant' |
| 11187 | * Constant: '<S38>/Constant1' |
| 11188 | */ |
| 11189 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.reserved.reserved1 = |
| 11190 | fusionAlg_P_g.Constant_Value_mu; |
| 11191 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.reserved.reserved0 = |
| 11192 | fusionAlg_P_g.Constant1_Value_m52; |
| 11193 | |
| 11194 | /* BusCreator: '<S38>/Bus Creator1' incorporates: |
| 11195 | * Constant: '<S38>/Constant10' |
| 11196 | * Constant: '<S38>/Constant2' |
| 11197 | * Constant: '<S38>/Constant3' |
| 11198 | * Constant: '<S38>/Constant4' |
| 11199 | * Constant: '<S38>/Constant5' |
| 11200 | * Constant: '<S38>/Constant6' |
| 11201 | * Constant: '<S38>/Constant9' |
| 11202 | */ |
| 11203 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objObstacleProb = |
| 11204 | fusionAlg_B.Selector22_c.RCS; |
| 11205 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objXPos_Stdev = |
| 11206 | fusionAlg_P_g.Constant2_Value_c2; |
| 11207 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objYPos_Stdev = |
| 11208 | fusionAlg_P_g.Constant3_Value_af; |
| 11209 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objXVelRel_Stdev = |
| 11210 | fusionAlg_P_g.Constant4_Value_bc; |
| 11211 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objXAccRel = |
| 11212 | fusionAlg_P_g.Constant5_Value_ca; |
| 11213 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objExstProb = |
| 11214 | fusionAlg_P_g.Constant6_Value_kr; |
| 11215 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objYVelRel = |
| 11216 | fusionAlg_B.Selector22_c.VrelLat; |
| 11217 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objXVelRel = |
| 11218 | fusionAlg_B.Selector22_c.VrelLong; |
| 11219 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objXPos = |
| 11220 | fusionAlg_B.Selector22_c.DistLong; |
| 11221 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objYPos = |
| 11222 | fusionAlg_B.Selector22_c.DistLat; |
| 11223 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objID = |
| 11224 | fusionAlg_B.DataTypeConversion_ic; |
| 11225 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objUpdateFlag = |
| 11226 | fusionAlg_B.Switch_kl; |
| 11227 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objValidFlag = |
| 11228 | fusionAlg_B.Switch_kl; |
| 11229 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objType = |
| 11230 | fusionAlg_P_g.Constant9_Value_pi; |
| 11231 | fusionAlg_B.BusCreator_i.radarObj.radar_30_obj.objMeasFlag = |
| 11232 | fusionAlg_P_g.Constant10_Value_ps; |
| 11233 | |
| 11234 | /* Selector: '<S13>/Selector23' incorporates: |
| 11235 | * Constant: '<S13>/Constant30' |
| 11236 | */ |
| 11237 | fusionAlg_B.Selector23_j = rtu_Radar308_Info_st-> |
| 11238 | leftFrontRadar_General[fusionAlg_P_g.Constant30_Value]; |
| 11239 | |
| 11240 | /* DataTypeConversion: '<S39>/Data Type Conversion' */ |
| 11241 | tmp = (real32_T)floor(fusionAlg_B.Selector23_j.ID); |
| 11242 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11243 | tmp = 0.0F; |
| 11244 | } else { |
| 11245 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11246 | } |
| 11247 | |
| 11248 | fusionAlg_B.DataTypeConversion_ne = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11249 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11250 | |
| 11251 | /* End of DataTypeConversion: '<S39>/Data Type Conversion' */ |
| 11252 | |
| 11253 | /* Switch: '<S39>/Switch' incorporates: |
| 11254 | * Constant: '<S39>/Constant7' |
| 11255 | * Constant: '<S39>/Constant8' |
| 11256 | */ |
| 11257 | if (fusionAlg_B.DataTypeConversion_ne > fusionAlg_P_g.Switch_Threshold_i) { |
| 11258 | fusionAlg_B.Switch_m = fusionAlg_P_g.Constant7_Value_cf; |
| 11259 | } else { |
| 11260 | fusionAlg_B.Switch_m = fusionAlg_P_g.Constant8_Value_gu; |
| 11261 | } |
| 11262 | |
| 11263 | /* End of Switch: '<S39>/Switch' */ |
| 11264 | |
| 11265 | /* DataTypeConversion: '<S39>/Data Type Conversion1' */ |
| 11266 | tmp = (real32_T)floor(fusionAlg_B.Selector23_j.DynProp); |
| 11267 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11268 | tmp = 0.0F; |
| 11269 | } else { |
| 11270 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11271 | } |
| 11272 | |
| 11273 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objMotionPattern = (uint8_T) |
| 11274 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11275 | tmp); |
| 11276 | |
| 11277 | /* End of DataTypeConversion: '<S39>/Data Type Conversion1' */ |
| 11278 | |
| 11279 | /* BusCreator: '<S39>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11280 | * Constant: '<S39>/Constant' |
| 11281 | * Constant: '<S39>/Constant1' |
| 11282 | */ |
| 11283 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.reserved.reserved1 = |
| 11284 | fusionAlg_P_g.Constant_Value_lj; |
| 11285 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.reserved.reserved0 = |
| 11286 | fusionAlg_P_g.Constant1_Value_g2; |
| 11287 | |
| 11288 | /* BusCreator: '<S39>/Bus Creator1' incorporates: |
| 11289 | * Constant: '<S39>/Constant10' |
| 11290 | * Constant: '<S39>/Constant2' |
| 11291 | * Constant: '<S39>/Constant3' |
| 11292 | * Constant: '<S39>/Constant4' |
| 11293 | * Constant: '<S39>/Constant5' |
| 11294 | * Constant: '<S39>/Constant6' |
| 11295 | * Constant: '<S39>/Constant9' |
| 11296 | */ |
| 11297 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objObstacleProb = |
| 11298 | fusionAlg_B.Selector23_j.RCS; |
| 11299 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objXPos_Stdev = |
| 11300 | fusionAlg_P_g.Constant2_Value_ck; |
| 11301 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objYPos_Stdev = |
| 11302 | fusionAlg_P_g.Constant3_Value_dq; |
| 11303 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objXVelRel_Stdev = |
| 11304 | fusionAlg_P_g.Constant4_Value_ed; |
| 11305 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objXAccRel = |
| 11306 | fusionAlg_P_g.Constant5_Value_ar; |
| 11307 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objExstProb = |
| 11308 | fusionAlg_P_g.Constant6_Value_i0; |
| 11309 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objYVelRel = |
| 11310 | fusionAlg_B.Selector23_j.VrelLat; |
| 11311 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objXVelRel = |
| 11312 | fusionAlg_B.Selector23_j.VrelLong; |
| 11313 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objXPos = |
| 11314 | fusionAlg_B.Selector23_j.DistLong; |
| 11315 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objYPos = |
| 11316 | fusionAlg_B.Selector23_j.DistLat; |
| 11317 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objID = |
| 11318 | fusionAlg_B.DataTypeConversion_ne; |
| 11319 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objUpdateFlag = |
| 11320 | fusionAlg_B.Switch_m; |
| 11321 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objValidFlag = |
| 11322 | fusionAlg_B.Switch_m; |
| 11323 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objType = |
| 11324 | fusionAlg_P_g.Constant9_Value_b1; |
| 11325 | fusionAlg_B.BusCreator_i.radarObj.radar_31_obj.objMeasFlag = |
| 11326 | fusionAlg_P_g.Constant10_Value_br; |
| 11327 | |
| 11328 | /* Selector: '<S13>/Selector31' incorporates: |
| 11329 | * Constant: '<S13>/Constant31' |
| 11330 | */ |
| 11331 | fusionAlg_B.Selector31_l = rtu_Radar308_Info_st-> |
| 11332 | leftFrontRadar_General[fusionAlg_P_g.Constant31_Value]; |
| 11333 | |
| 11334 | /* DataTypeConversion: '<S40>/Data Type Conversion' */ |
| 11335 | tmp = (real32_T)floor(fusionAlg_B.Selector31_l.ID); |
| 11336 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11337 | tmp = 0.0F; |
| 11338 | } else { |
| 11339 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11340 | } |
| 11341 | |
| 11342 | fusionAlg_B.DataTypeConversion_el = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11343 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11344 | |
| 11345 | /* End of DataTypeConversion: '<S40>/Data Type Conversion' */ |
| 11346 | |
| 11347 | /* Switch: '<S40>/Switch' incorporates: |
| 11348 | * Constant: '<S40>/Constant7' |
| 11349 | * Constant: '<S40>/Constant8' |
| 11350 | */ |
| 11351 | if (fusionAlg_B.DataTypeConversion_el > fusionAlg_P_g.Switch_Threshold_ml) { |
| 11352 | fusionAlg_B.Switch_oy = fusionAlg_P_g.Constant7_Value_pb; |
| 11353 | } else { |
| 11354 | fusionAlg_B.Switch_oy = fusionAlg_P_g.Constant8_Value_ev; |
| 11355 | } |
| 11356 | |
| 11357 | /* End of Switch: '<S40>/Switch' */ |
| 11358 | |
| 11359 | /* DataTypeConversion: '<S40>/Data Type Conversion1' */ |
| 11360 | tmp = (real32_T)floor(fusionAlg_B.Selector31_l.DynProp); |
| 11361 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11362 | tmp = 0.0F; |
| 11363 | } else { |
| 11364 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11365 | } |
| 11366 | |
| 11367 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objMotionPattern = (uint8_T) |
| 11368 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11369 | tmp); |
| 11370 | |
| 11371 | /* End of DataTypeConversion: '<S40>/Data Type Conversion1' */ |
| 11372 | |
| 11373 | /* BusCreator: '<S40>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11374 | * Constant: '<S40>/Constant' |
| 11375 | * Constant: '<S40>/Constant1' |
| 11376 | */ |
| 11377 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.reserved.reserved1 = |
| 11378 | fusionAlg_P_g.Constant_Value_j3; |
| 11379 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.reserved.reserved0 = |
| 11380 | fusionAlg_P_g.Constant1_Value_o5; |
| 11381 | |
| 11382 | /* BusCreator: '<S40>/Bus Creator1' incorporates: |
| 11383 | * Constant: '<S40>/Constant10' |
| 11384 | * Constant: '<S40>/Constant2' |
| 11385 | * Constant: '<S40>/Constant3' |
| 11386 | * Constant: '<S40>/Constant4' |
| 11387 | * Constant: '<S40>/Constant5' |
| 11388 | * Constant: '<S40>/Constant6' |
| 11389 | * Constant: '<S40>/Constant9' |
| 11390 | */ |
| 11391 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objObstacleProb = |
| 11392 | fusionAlg_B.Selector31_l.RCS; |
| 11393 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objXPos_Stdev = |
| 11394 | fusionAlg_P_g.Constant2_Value_fz; |
| 11395 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objYPos_Stdev = |
| 11396 | fusionAlg_P_g.Constant3_Value_bv; |
| 11397 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objXVelRel_Stdev = |
| 11398 | fusionAlg_P_g.Constant4_Value_ca; |
| 11399 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objXAccRel = |
| 11400 | fusionAlg_P_g.Constant5_Value_k1; |
| 11401 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objExstProb = |
| 11402 | fusionAlg_P_g.Constant6_Value_nr; |
| 11403 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objYVelRel = |
| 11404 | fusionAlg_B.Selector31_l.VrelLat; |
| 11405 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objXVelRel = |
| 11406 | fusionAlg_B.Selector31_l.VrelLong; |
| 11407 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objXPos = |
| 11408 | fusionAlg_B.Selector31_l.DistLong; |
| 11409 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objYPos = |
| 11410 | fusionAlg_B.Selector31_l.DistLat; |
| 11411 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objID = |
| 11412 | fusionAlg_B.DataTypeConversion_el; |
| 11413 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objUpdateFlag = |
| 11414 | fusionAlg_B.Switch_oy; |
| 11415 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objValidFlag = |
| 11416 | fusionAlg_B.Switch_oy; |
| 11417 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objType = |
| 11418 | fusionAlg_P_g.Constant9_Value_h; |
| 11419 | fusionAlg_B.BusCreator_i.radarObj.radar_32_obj.objMeasFlag = |
| 11420 | fusionAlg_P_g.Constant10_Value_n; |
| 11421 | |
| 11422 | /* Selector: '<S13>/Selector32' incorporates: |
| 11423 | * Constant: '<S13>/Constant32' |
| 11424 | */ |
| 11425 | fusionAlg_B.Selector32_c = rtu_Radar308_Info_st-> |
| 11426 | leftFrontRadar_General[fusionAlg_P_g.Constant32_Value]; |
| 11427 | |
| 11428 | /* DataTypeConversion: '<S41>/Data Type Conversion' */ |
| 11429 | tmp = (real32_T)floor(fusionAlg_B.Selector32_c.ID); |
| 11430 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11431 | tmp = 0.0F; |
| 11432 | } else { |
| 11433 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11434 | } |
| 11435 | |
| 11436 | fusionAlg_B.DataTypeConversion_ph = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11437 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11438 | |
| 11439 | /* End of DataTypeConversion: '<S41>/Data Type Conversion' */ |
| 11440 | |
| 11441 | /* Switch: '<S41>/Switch' incorporates: |
| 11442 | * Constant: '<S41>/Constant7' |
| 11443 | * Constant: '<S41>/Constant8' |
| 11444 | */ |
| 11445 | if (fusionAlg_B.DataTypeConversion_ph > fusionAlg_P_g.Switch_Threshold_dh) { |
| 11446 | fusionAlg_B.Switch_mw = fusionAlg_P_g.Constant7_Value_bn; |
| 11447 | } else { |
| 11448 | fusionAlg_B.Switch_mw = fusionAlg_P_g.Constant8_Value_bvj; |
| 11449 | } |
| 11450 | |
| 11451 | /* End of Switch: '<S41>/Switch' */ |
| 11452 | |
| 11453 | /* DataTypeConversion: '<S41>/Data Type Conversion1' */ |
| 11454 | tmp = (real32_T)floor(fusionAlg_B.Selector32_c.DynProp); |
| 11455 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11456 | tmp = 0.0F; |
| 11457 | } else { |
| 11458 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11459 | } |
| 11460 | |
| 11461 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objMotionPattern = (uint8_T) |
| 11462 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11463 | tmp); |
| 11464 | |
| 11465 | /* End of DataTypeConversion: '<S41>/Data Type Conversion1' */ |
| 11466 | |
| 11467 | /* BusCreator: '<S41>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11468 | * Constant: '<S41>/Constant' |
| 11469 | * Constant: '<S41>/Constant1' |
| 11470 | */ |
| 11471 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.reserved.reserved1 = |
| 11472 | fusionAlg_P_g.Constant_Value_df; |
| 11473 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.reserved.reserved0 = |
| 11474 | fusionAlg_P_g.Constant1_Value_fb; |
| 11475 | |
| 11476 | /* BusCreator: '<S41>/Bus Creator1' incorporates: |
| 11477 | * Constant: '<S41>/Constant10' |
| 11478 | * Constant: '<S41>/Constant2' |
| 11479 | * Constant: '<S41>/Constant3' |
| 11480 | * Constant: '<S41>/Constant4' |
| 11481 | * Constant: '<S41>/Constant5' |
| 11482 | * Constant: '<S41>/Constant6' |
| 11483 | * Constant: '<S41>/Constant9' |
| 11484 | */ |
| 11485 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objObstacleProb = |
| 11486 | fusionAlg_B.Selector32_c.RCS; |
| 11487 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objXPos_Stdev = |
| 11488 | fusionAlg_P_g.Constant2_Value_jk; |
| 11489 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objYPos_Stdev = |
| 11490 | fusionAlg_P_g.Constant3_Value_oa; |
| 11491 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objXVelRel_Stdev = |
| 11492 | fusionAlg_P_g.Constant4_Value_an; |
| 11493 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objXAccRel = |
| 11494 | fusionAlg_P_g.Constant5_Value_lc; |
| 11495 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objExstProb = |
| 11496 | fusionAlg_P_g.Constant6_Value_a; |
| 11497 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objYVelRel = |
| 11498 | fusionAlg_B.Selector32_c.VrelLat; |
| 11499 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objXVelRel = |
| 11500 | fusionAlg_B.Selector32_c.VrelLong; |
| 11501 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objXPos = |
| 11502 | fusionAlg_B.Selector32_c.DistLong; |
| 11503 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objYPos = |
| 11504 | fusionAlg_B.Selector32_c.DistLat; |
| 11505 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objID = |
| 11506 | fusionAlg_B.DataTypeConversion_ph; |
| 11507 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objUpdateFlag = |
| 11508 | fusionAlg_B.Switch_mw; |
| 11509 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objValidFlag = |
| 11510 | fusionAlg_B.Switch_mw; |
| 11511 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objType = |
| 11512 | fusionAlg_P_g.Constant9_Value_mj; |
| 11513 | fusionAlg_B.BusCreator_i.radarObj.radar_33_obj.objMeasFlag = |
| 11514 | fusionAlg_P_g.Constant10_Value_i1; |
| 11515 | |
| 11516 | /* Selector: '<S13>/Selector33' incorporates: |
| 11517 | * Constant: '<S13>/Constant33' |
| 11518 | */ |
| 11519 | fusionAlg_B.Selector33_n = rtu_Radar308_Info_st-> |
| 11520 | leftFrontRadar_General[fusionAlg_P_g.Constant33_Value]; |
| 11521 | |
| 11522 | /* DataTypeConversion: '<S42>/Data Type Conversion' */ |
| 11523 | tmp = (real32_T)floor(fusionAlg_B.Selector33_n.ID); |
| 11524 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11525 | tmp = 0.0F; |
| 11526 | } else { |
| 11527 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11528 | } |
| 11529 | |
| 11530 | fusionAlg_B.DataTypeConversion_es = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11531 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11532 | |
| 11533 | /* End of DataTypeConversion: '<S42>/Data Type Conversion' */ |
| 11534 | |
| 11535 | /* Switch: '<S42>/Switch' incorporates: |
| 11536 | * Constant: '<S42>/Constant7' |
| 11537 | * Constant: '<S42>/Constant8' |
| 11538 | */ |
| 11539 | if (fusionAlg_B.DataTypeConversion_es > fusionAlg_P_g.Switch_Threshold_mn) { |
| 11540 | fusionAlg_B.Switch_fe = fusionAlg_P_g.Constant7_Value_ja; |
| 11541 | } else { |
| 11542 | fusionAlg_B.Switch_fe = fusionAlg_P_g.Constant8_Value_m5; |
| 11543 | } |
| 11544 | |
| 11545 | /* End of Switch: '<S42>/Switch' */ |
| 11546 | |
| 11547 | /* DataTypeConversion: '<S42>/Data Type Conversion1' */ |
| 11548 | tmp = (real32_T)floor(fusionAlg_B.Selector33_n.DynProp); |
| 11549 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11550 | tmp = 0.0F; |
| 11551 | } else { |
| 11552 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11553 | } |
| 11554 | |
| 11555 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objMotionPattern = (uint8_T) |
| 11556 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11557 | tmp); |
| 11558 | |
| 11559 | /* End of DataTypeConversion: '<S42>/Data Type Conversion1' */ |
| 11560 | |
| 11561 | /* BusCreator: '<S42>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11562 | * Constant: '<S42>/Constant' |
| 11563 | * Constant: '<S42>/Constant1' |
| 11564 | */ |
| 11565 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.reserved.reserved1 = |
| 11566 | fusionAlg_P_g.Constant_Value_mj; |
| 11567 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.reserved.reserved0 = |
| 11568 | fusionAlg_P_g.Constant1_Value_e3; |
| 11569 | |
| 11570 | /* BusCreator: '<S42>/Bus Creator1' incorporates: |
| 11571 | * Constant: '<S42>/Constant10' |
| 11572 | * Constant: '<S42>/Constant2' |
| 11573 | * Constant: '<S42>/Constant3' |
| 11574 | * Constant: '<S42>/Constant4' |
| 11575 | * Constant: '<S42>/Constant5' |
| 11576 | * Constant: '<S42>/Constant6' |
| 11577 | * Constant: '<S42>/Constant9' |
| 11578 | */ |
| 11579 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objObstacleProb = |
| 11580 | fusionAlg_B.Selector33_n.RCS; |
| 11581 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objXPos_Stdev = |
| 11582 | fusionAlg_P_g.Constant2_Value_gi; |
| 11583 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objYPos_Stdev = |
| 11584 | fusionAlg_P_g.Constant3_Value_i; |
| 11585 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objXVelRel_Stdev = |
| 11586 | fusionAlg_P_g.Constant4_Value_bv; |
| 11587 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objXAccRel = |
| 11588 | fusionAlg_P_g.Constant5_Value_dy; |
| 11589 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objExstProb = |
| 11590 | fusionAlg_P_g.Constant6_Value_aa; |
| 11591 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objYVelRel = |
| 11592 | fusionAlg_B.Selector33_n.VrelLat; |
| 11593 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objXVelRel = |
| 11594 | fusionAlg_B.Selector33_n.VrelLong; |
| 11595 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objXPos = |
| 11596 | fusionAlg_B.Selector33_n.DistLong; |
| 11597 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objYPos = |
| 11598 | fusionAlg_B.Selector33_n.DistLat; |
| 11599 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objID = |
| 11600 | fusionAlg_B.DataTypeConversion_es; |
| 11601 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objUpdateFlag = |
| 11602 | fusionAlg_B.Switch_fe; |
| 11603 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objValidFlag = |
| 11604 | fusionAlg_B.Switch_fe; |
| 11605 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objType = |
| 11606 | fusionAlg_P_g.Constant9_Value_af; |
| 11607 | fusionAlg_B.BusCreator_i.radarObj.radar_34_obj.objMeasFlag = |
| 11608 | fusionAlg_P_g.Constant10_Value_dst; |
| 11609 | |
| 11610 | /* Selector: '<S13>/Selector34' incorporates: |
| 11611 | * Constant: '<S13>/Constant34' |
| 11612 | */ |
| 11613 | fusionAlg_B.Selector34_m = rtu_Radar308_Info_st-> |
| 11614 | leftFrontRadar_General[fusionAlg_P_g.Constant34_Value]; |
| 11615 | |
| 11616 | /* DataTypeConversion: '<S43>/Data Type Conversion' */ |
| 11617 | tmp = (real32_T)floor(fusionAlg_B.Selector34_m.ID); |
| 11618 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11619 | tmp = 0.0F; |
| 11620 | } else { |
| 11621 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11622 | } |
| 11623 | |
| 11624 | fusionAlg_B.DataTypeConversion_ad = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11625 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11626 | |
| 11627 | /* End of DataTypeConversion: '<S43>/Data Type Conversion' */ |
| 11628 | |
| 11629 | /* Switch: '<S43>/Switch' incorporates: |
| 11630 | * Constant: '<S43>/Constant7' |
| 11631 | * Constant: '<S43>/Constant8' |
| 11632 | */ |
| 11633 | if (fusionAlg_B.DataTypeConversion_ad > fusionAlg_P_g.Switch_Threshold_dvp) { |
| 11634 | fusionAlg_B.Switch_nj1 = fusionAlg_P_g.Constant7_Value_bj; |
| 11635 | } else { |
| 11636 | fusionAlg_B.Switch_nj1 = fusionAlg_P_g.Constant8_Value_fg; |
| 11637 | } |
| 11638 | |
| 11639 | /* End of Switch: '<S43>/Switch' */ |
| 11640 | |
| 11641 | /* DataTypeConversion: '<S43>/Data Type Conversion1' */ |
| 11642 | tmp = (real32_T)floor(fusionAlg_B.Selector34_m.DynProp); |
| 11643 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11644 | tmp = 0.0F; |
| 11645 | } else { |
| 11646 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11647 | } |
| 11648 | |
| 11649 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objMotionPattern = (uint8_T) |
| 11650 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11651 | tmp); |
| 11652 | |
| 11653 | /* End of DataTypeConversion: '<S43>/Data Type Conversion1' */ |
| 11654 | |
| 11655 | /* BusCreator: '<S43>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11656 | * Constant: '<S43>/Constant' |
| 11657 | * Constant: '<S43>/Constant1' |
| 11658 | */ |
| 11659 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.reserved.reserved1 = |
| 11660 | fusionAlg_P_g.Constant_Value_fs1; |
| 11661 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.reserved.reserved0 = |
| 11662 | fusionAlg_P_g.Constant1_Value_hn; |
| 11663 | |
| 11664 | /* BusCreator: '<S43>/Bus Creator1' incorporates: |
| 11665 | * Constant: '<S43>/Constant10' |
| 11666 | * Constant: '<S43>/Constant2' |
| 11667 | * Constant: '<S43>/Constant3' |
| 11668 | * Constant: '<S43>/Constant4' |
| 11669 | * Constant: '<S43>/Constant5' |
| 11670 | * Constant: '<S43>/Constant6' |
| 11671 | * Constant: '<S43>/Constant9' |
| 11672 | */ |
| 11673 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objObstacleProb = |
| 11674 | fusionAlg_B.Selector34_m.RCS; |
| 11675 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objXPos_Stdev = |
| 11676 | fusionAlg_P_g.Constant2_Value_a4; |
| 11677 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objYPos_Stdev = |
| 11678 | fusionAlg_P_g.Constant3_Value_pi; |
| 11679 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objXVelRel_Stdev = |
| 11680 | fusionAlg_P_g.Constant4_Value_le; |
| 11681 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objXAccRel = |
| 11682 | fusionAlg_P_g.Constant5_Value_n0; |
| 11683 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objExstProb = |
| 11684 | fusionAlg_P_g.Constant6_Value_bk; |
| 11685 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objYVelRel = |
| 11686 | fusionAlg_B.Selector34_m.VrelLat; |
| 11687 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objXVelRel = |
| 11688 | fusionAlg_B.Selector34_m.VrelLong; |
| 11689 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objXPos = |
| 11690 | fusionAlg_B.Selector34_m.DistLong; |
| 11691 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objYPos = |
| 11692 | fusionAlg_B.Selector34_m.DistLat; |
| 11693 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objID = |
| 11694 | fusionAlg_B.DataTypeConversion_ad; |
| 11695 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objUpdateFlag = |
| 11696 | fusionAlg_B.Switch_nj1; |
| 11697 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objValidFlag = |
| 11698 | fusionAlg_B.Switch_nj1; |
| 11699 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objType = |
| 11700 | fusionAlg_P_g.Constant9_Value_bs; |
| 11701 | fusionAlg_B.BusCreator_i.radarObj.radar_35_obj.objMeasFlag = |
| 11702 | fusionAlg_P_g.Constant10_Value_gf; |
| 11703 | |
| 11704 | /* Selector: '<S13>/Selector35' incorporates: |
| 11705 | * Constant: '<S13>/Constant35' |
| 11706 | */ |
| 11707 | fusionAlg_B.Selector35_h = rtu_Radar308_Info_st-> |
| 11708 | leftFrontRadar_General[fusionAlg_P_g.Constant35_Value]; |
| 11709 | |
| 11710 | /* DataTypeConversion: '<S44>/Data Type Conversion' */ |
| 11711 | tmp = (real32_T)floor(fusionAlg_B.Selector35_h.ID); |
| 11712 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11713 | tmp = 0.0F; |
| 11714 | } else { |
| 11715 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11716 | } |
| 11717 | |
| 11718 | fusionAlg_B.DataTypeConversion_aj = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11719 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11720 | |
| 11721 | /* End of DataTypeConversion: '<S44>/Data Type Conversion' */ |
| 11722 | |
| 11723 | /* Switch: '<S44>/Switch' incorporates: |
| 11724 | * Constant: '<S44>/Constant7' |
| 11725 | * Constant: '<S44>/Constant8' |
| 11726 | */ |
| 11727 | if (fusionAlg_B.DataTypeConversion_aj > fusionAlg_P_g.Switch_Threshold_e3) { |
| 11728 | fusionAlg_B.Switch_ea = fusionAlg_P_g.Constant7_Value_a4; |
| 11729 | } else { |
| 11730 | fusionAlg_B.Switch_ea = fusionAlg_P_g.Constant8_Value_l; |
| 11731 | } |
| 11732 | |
| 11733 | /* End of Switch: '<S44>/Switch' */ |
| 11734 | |
| 11735 | /* DataTypeConversion: '<S44>/Data Type Conversion1' */ |
| 11736 | tmp = (real32_T)floor(fusionAlg_B.Selector35_h.DynProp); |
| 11737 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11738 | tmp = 0.0F; |
| 11739 | } else { |
| 11740 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11741 | } |
| 11742 | |
| 11743 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objMotionPattern = (uint8_T) |
| 11744 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11745 | tmp); |
| 11746 | |
| 11747 | /* End of DataTypeConversion: '<S44>/Data Type Conversion1' */ |
| 11748 | |
| 11749 | /* BusCreator: '<S44>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11750 | * Constant: '<S44>/Constant' |
| 11751 | * Constant: '<S44>/Constant1' |
| 11752 | */ |
| 11753 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.reserved.reserved1 = |
| 11754 | fusionAlg_P_g.Constant_Value_fh; |
| 11755 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.reserved.reserved0 = |
| 11756 | fusionAlg_P_g.Constant1_Value_cqq; |
| 11757 | |
| 11758 | /* BusCreator: '<S44>/Bus Creator1' incorporates: |
| 11759 | * Constant: '<S44>/Constant10' |
| 11760 | * Constant: '<S44>/Constant2' |
| 11761 | * Constant: '<S44>/Constant3' |
| 11762 | * Constant: '<S44>/Constant4' |
| 11763 | * Constant: '<S44>/Constant5' |
| 11764 | * Constant: '<S44>/Constant6' |
| 11765 | * Constant: '<S44>/Constant9' |
| 11766 | */ |
| 11767 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objObstacleProb = |
| 11768 | fusionAlg_B.Selector35_h.RCS; |
| 11769 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objXPos_Stdev = |
| 11770 | fusionAlg_P_g.Constant2_Value_f5; |
| 11771 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objYPos_Stdev = |
| 11772 | fusionAlg_P_g.Constant3_Value_a0; |
| 11773 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objXVelRel_Stdev = |
| 11774 | fusionAlg_P_g.Constant4_Value_gn; |
| 11775 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objXAccRel = |
| 11776 | fusionAlg_P_g.Constant5_Value_gg; |
| 11777 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objExstProb = |
| 11778 | fusionAlg_P_g.Constant6_Value_n1; |
| 11779 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objYVelRel = |
| 11780 | fusionAlg_B.Selector35_h.VrelLat; |
| 11781 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objXVelRel = |
| 11782 | fusionAlg_B.Selector35_h.VrelLong; |
| 11783 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objXPos = |
| 11784 | fusionAlg_B.Selector35_h.DistLong; |
| 11785 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objYPos = |
| 11786 | fusionAlg_B.Selector35_h.DistLat; |
| 11787 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objID = |
| 11788 | fusionAlg_B.DataTypeConversion_aj; |
| 11789 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objUpdateFlag = |
| 11790 | fusionAlg_B.Switch_ea; |
| 11791 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objValidFlag = |
| 11792 | fusionAlg_B.Switch_ea; |
| 11793 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objType = |
| 11794 | fusionAlg_P_g.Constant9_Value_an; |
| 11795 | fusionAlg_B.BusCreator_i.radarObj.radar_36_obj.objMeasFlag = |
| 11796 | fusionAlg_P_g.Constant10_Value_jt; |
| 11797 | |
| 11798 | /* Selector: '<S13>/Selector36' incorporates: |
| 11799 | * Constant: '<S13>/Constant36' |
| 11800 | */ |
| 11801 | fusionAlg_B.Selector36_d = rtu_Radar308_Info_st-> |
| 11802 | leftFrontRadar_General[fusionAlg_P_g.Constant36_Value]; |
| 11803 | |
| 11804 | /* DataTypeConversion: '<S45>/Data Type Conversion' */ |
| 11805 | tmp = (real32_T)floor(fusionAlg_B.Selector36_d.ID); |
| 11806 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11807 | tmp = 0.0F; |
| 11808 | } else { |
| 11809 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11810 | } |
| 11811 | |
| 11812 | fusionAlg_B.DataTypeConversion_p5 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11813 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11814 | |
| 11815 | /* End of DataTypeConversion: '<S45>/Data Type Conversion' */ |
| 11816 | |
| 11817 | /* Switch: '<S45>/Switch' incorporates: |
| 11818 | * Constant: '<S45>/Constant7' |
| 11819 | * Constant: '<S45>/Constant8' |
| 11820 | */ |
| 11821 | if (fusionAlg_B.DataTypeConversion_p5 > fusionAlg_P_g.Switch_Threshold_a0) { |
| 11822 | fusionAlg_B.Switch_g = fusionAlg_P_g.Constant7_Value_mb; |
| 11823 | } else { |
| 11824 | fusionAlg_B.Switch_g = fusionAlg_P_g.Constant8_Value_bs; |
| 11825 | } |
| 11826 | |
| 11827 | /* End of Switch: '<S45>/Switch' */ |
| 11828 | |
| 11829 | /* DataTypeConversion: '<S45>/Data Type Conversion1' */ |
| 11830 | tmp = (real32_T)floor(fusionAlg_B.Selector36_d.DynProp); |
| 11831 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11832 | tmp = 0.0F; |
| 11833 | } else { |
| 11834 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11835 | } |
| 11836 | |
| 11837 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objMotionPattern = (uint8_T) |
| 11838 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11839 | tmp); |
| 11840 | |
| 11841 | /* End of DataTypeConversion: '<S45>/Data Type Conversion1' */ |
| 11842 | |
| 11843 | /* BusCreator: '<S45>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11844 | * Constant: '<S45>/Constant' |
| 11845 | * Constant: '<S45>/Constant1' |
| 11846 | */ |
| 11847 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.reserved.reserved1 = |
| 11848 | fusionAlg_P_g.Constant_Value_gu; |
| 11849 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.reserved.reserved0 = |
| 11850 | fusionAlg_P_g.Constant1_Value_mv; |
| 11851 | |
| 11852 | /* BusCreator: '<S45>/Bus Creator1' incorporates: |
| 11853 | * Constant: '<S45>/Constant10' |
| 11854 | * Constant: '<S45>/Constant2' |
| 11855 | * Constant: '<S45>/Constant3' |
| 11856 | * Constant: '<S45>/Constant4' |
| 11857 | * Constant: '<S45>/Constant5' |
| 11858 | * Constant: '<S45>/Constant6' |
| 11859 | * Constant: '<S45>/Constant9' |
| 11860 | */ |
| 11861 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objObstacleProb = |
| 11862 | fusionAlg_B.Selector36_d.RCS; |
| 11863 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objXPos_Stdev = |
| 11864 | fusionAlg_P_g.Constant2_Value_lp; |
| 11865 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objYPos_Stdev = |
| 11866 | fusionAlg_P_g.Constant3_Value_m1; |
| 11867 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objXVelRel_Stdev = |
| 11868 | fusionAlg_P_g.Constant4_Value_ph; |
| 11869 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objXAccRel = |
| 11870 | fusionAlg_P_g.Constant5_Value_f4; |
| 11871 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objExstProb = |
| 11872 | fusionAlg_P_g.Constant6_Value_ge; |
| 11873 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objYVelRel = |
| 11874 | fusionAlg_B.Selector36_d.VrelLat; |
| 11875 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objXVelRel = |
| 11876 | fusionAlg_B.Selector36_d.VrelLong; |
| 11877 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objXPos = |
| 11878 | fusionAlg_B.Selector36_d.DistLong; |
| 11879 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objYPos = |
| 11880 | fusionAlg_B.Selector36_d.DistLat; |
| 11881 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objID = |
| 11882 | fusionAlg_B.DataTypeConversion_p5; |
| 11883 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objUpdateFlag = |
| 11884 | fusionAlg_B.Switch_g; |
| 11885 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objValidFlag = |
| 11886 | fusionAlg_B.Switch_g; |
| 11887 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objType = |
| 11888 | fusionAlg_P_g.Constant9_Value_gs; |
| 11889 | fusionAlg_B.BusCreator_i.radarObj.radar_37_obj.objMeasFlag = |
| 11890 | fusionAlg_P_g.Constant10_Value_mp; |
| 11891 | |
| 11892 | /* Selector: '<S13>/Selector37' incorporates: |
| 11893 | * Constant: '<S13>/Constant37' |
| 11894 | */ |
| 11895 | fusionAlg_B.Selector37_k = rtu_Radar308_Info_st-> |
| 11896 | leftFrontRadar_General[fusionAlg_P_g.Constant37_Value]; |
| 11897 | |
| 11898 | /* DataTypeConversion: '<S46>/Data Type Conversion' */ |
| 11899 | tmp = (real32_T)floor(fusionAlg_B.Selector37_k.ID); |
| 11900 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11901 | tmp = 0.0F; |
| 11902 | } else { |
| 11903 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11904 | } |
| 11905 | |
| 11906 | fusionAlg_B.DataTypeConversion_jv = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 11907 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 11908 | |
| 11909 | /* End of DataTypeConversion: '<S46>/Data Type Conversion' */ |
| 11910 | |
| 11911 | /* Switch: '<S46>/Switch' incorporates: |
| 11912 | * Constant: '<S46>/Constant7' |
| 11913 | * Constant: '<S46>/Constant8' |
| 11914 | */ |
| 11915 | if (fusionAlg_B.DataTypeConversion_jv > fusionAlg_P_g.Switch_Threshold_eb) { |
| 11916 | fusionAlg_B.Switch_pi = fusionAlg_P_g.Constant7_Value_fw; |
| 11917 | } else { |
| 11918 | fusionAlg_B.Switch_pi = fusionAlg_P_g.Constant8_Value_ir; |
| 11919 | } |
| 11920 | |
| 11921 | /* End of Switch: '<S46>/Switch' */ |
| 11922 | |
| 11923 | /* DataTypeConversion: '<S46>/Data Type Conversion1' */ |
| 11924 | tmp = (real32_T)floor(fusionAlg_B.Selector37_k.DynProp); |
| 11925 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11926 | tmp = 0.0F; |
| 11927 | } else { |
| 11928 | tmp = (real32_T)fmod(tmp, 256.0); |
| 11929 | } |
| 11930 | |
| 11931 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objMotionPattern = (uint8_T) |
| 11932 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 11933 | tmp); |
| 11934 | |
| 11935 | /* End of DataTypeConversion: '<S46>/Data Type Conversion1' */ |
| 11936 | |
| 11937 | /* BusCreator: '<S46>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 11938 | * Constant: '<S46>/Constant' |
| 11939 | * Constant: '<S46>/Constant1' |
| 11940 | */ |
| 11941 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.reserved.reserved1 = |
| 11942 | fusionAlg_P_g.Constant_Value_ewj; |
| 11943 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.reserved.reserved0 = |
| 11944 | fusionAlg_P_g.Constant1_Value_h2; |
| 11945 | |
| 11946 | /* BusCreator: '<S46>/Bus Creator1' incorporates: |
| 11947 | * Constant: '<S46>/Constant10' |
| 11948 | * Constant: '<S46>/Constant2' |
| 11949 | * Constant: '<S46>/Constant3' |
| 11950 | * Constant: '<S46>/Constant4' |
| 11951 | * Constant: '<S46>/Constant5' |
| 11952 | * Constant: '<S46>/Constant6' |
| 11953 | * Constant: '<S46>/Constant9' |
| 11954 | */ |
| 11955 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objObstacleProb = |
| 11956 | fusionAlg_B.Selector37_k.RCS; |
| 11957 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objXPos_Stdev = |
| 11958 | fusionAlg_P_g.Constant2_Value_in; |
| 11959 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objYPos_Stdev = |
| 11960 | fusionAlg_P_g.Constant3_Value_jw5; |
| 11961 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objXVelRel_Stdev = |
| 11962 | fusionAlg_P_g.Constant4_Value_gj; |
| 11963 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objXAccRel = |
| 11964 | fusionAlg_P_g.Constant5_Value_jt; |
| 11965 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objExstProb = |
| 11966 | fusionAlg_P_g.Constant6_Value_b2; |
| 11967 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objYVelRel = |
| 11968 | fusionAlg_B.Selector37_k.VrelLat; |
| 11969 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objXVelRel = |
| 11970 | fusionAlg_B.Selector37_k.VrelLong; |
| 11971 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objXPos = |
| 11972 | fusionAlg_B.Selector37_k.DistLong; |
| 11973 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objYPos = |
| 11974 | fusionAlg_B.Selector37_k.DistLat; |
| 11975 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objID = |
| 11976 | fusionAlg_B.DataTypeConversion_jv; |
| 11977 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objUpdateFlag = |
| 11978 | fusionAlg_B.Switch_pi; |
| 11979 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objValidFlag = |
| 11980 | fusionAlg_B.Switch_pi; |
| 11981 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objType = |
| 11982 | fusionAlg_P_g.Constant9_Value_jd; |
| 11983 | fusionAlg_B.BusCreator_i.radarObj.radar_38_obj.objMeasFlag = |
| 11984 | fusionAlg_P_g.Constant10_Value_ph; |
| 11985 | |
| 11986 | /* Selector: '<S13>/Selector38' incorporates: |
| 11987 | * Constant: '<S13>/Constant38' |
| 11988 | */ |
| 11989 | fusionAlg_B.Selector38_o = rtu_Radar308_Info_st-> |
| 11990 | leftFrontRadar_General[fusionAlg_P_g.Constant38_Value]; |
| 11991 | |
| 11992 | /* DataTypeConversion: '<S47>/Data Type Conversion' */ |
| 11993 | tmp = (real32_T)floor(fusionAlg_B.Selector38_o.ID); |
| 11994 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 11995 | tmp = 0.0F; |
| 11996 | } else { |
| 11997 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 11998 | } |
| 11999 | |
| 12000 | fusionAlg_B.DataTypeConversion_go = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12001 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12002 | |
| 12003 | /* End of DataTypeConversion: '<S47>/Data Type Conversion' */ |
| 12004 | |
| 12005 | /* Switch: '<S47>/Switch' incorporates: |
| 12006 | * Constant: '<S47>/Constant7' |
| 12007 | * Constant: '<S47>/Constant8' |
| 12008 | */ |
| 12009 | if (fusionAlg_B.DataTypeConversion_go > fusionAlg_P_g.Switch_Threshold_ju) { |
| 12010 | fusionAlg_B.Switch_kp = fusionAlg_P_g.Constant7_Value_pbu; |
| 12011 | } else { |
| 12012 | fusionAlg_B.Switch_kp = fusionAlg_P_g.Constant8_Value_bjr; |
| 12013 | } |
| 12014 | |
| 12015 | /* End of Switch: '<S47>/Switch' */ |
| 12016 | |
| 12017 | /* DataTypeConversion: '<S47>/Data Type Conversion1' */ |
| 12018 | tmp = (real32_T)floor(fusionAlg_B.Selector38_o.DynProp); |
| 12019 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12020 | tmp = 0.0F; |
| 12021 | } else { |
| 12022 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12023 | } |
| 12024 | |
| 12025 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objMotionPattern = (uint8_T) |
| 12026 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12027 | tmp); |
| 12028 | |
| 12029 | /* End of DataTypeConversion: '<S47>/Data Type Conversion1' */ |
| 12030 | |
| 12031 | /* BusCreator: '<S47>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12032 | * Constant: '<S47>/Constant' |
| 12033 | * Constant: '<S47>/Constant1' |
| 12034 | */ |
| 12035 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.reserved.reserved1 = |
| 12036 | fusionAlg_P_g.Constant_Value_ou; |
| 12037 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.reserved.reserved0 = |
| 12038 | fusionAlg_P_g.Constant1_Value_oo; |
| 12039 | |
| 12040 | /* BusCreator: '<S47>/Bus Creator1' incorporates: |
| 12041 | * Constant: '<S47>/Constant10' |
| 12042 | * Constant: '<S47>/Constant2' |
| 12043 | * Constant: '<S47>/Constant3' |
| 12044 | * Constant: '<S47>/Constant4' |
| 12045 | * Constant: '<S47>/Constant5' |
| 12046 | * Constant: '<S47>/Constant6' |
| 12047 | * Constant: '<S47>/Constant9' |
| 12048 | */ |
| 12049 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objObstacleProb = |
| 12050 | fusionAlg_B.Selector38_o.RCS; |
| 12051 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objXPos_Stdev = |
| 12052 | fusionAlg_P_g.Constant2_Value_gig; |
| 12053 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objYPos_Stdev = |
| 12054 | fusionAlg_P_g.Constant3_Value_e; |
| 12055 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objXVelRel_Stdev = |
| 12056 | fusionAlg_P_g.Constant4_Value_l5; |
| 12057 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objXAccRel = |
| 12058 | fusionAlg_P_g.Constant5_Value_m; |
| 12059 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objExstProb = |
| 12060 | fusionAlg_P_g.Constant6_Value_bb; |
| 12061 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objYVelRel = |
| 12062 | fusionAlg_B.Selector38_o.VrelLat; |
| 12063 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objXVelRel = |
| 12064 | fusionAlg_B.Selector38_o.VrelLong; |
| 12065 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objXPos = |
| 12066 | fusionAlg_B.Selector38_o.DistLong; |
| 12067 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objYPos = |
| 12068 | fusionAlg_B.Selector38_o.DistLat; |
| 12069 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objID = |
| 12070 | fusionAlg_B.DataTypeConversion_go; |
| 12071 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objUpdateFlag = |
| 12072 | fusionAlg_B.Switch_kp; |
| 12073 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objValidFlag = |
| 12074 | fusionAlg_B.Switch_kp; |
| 12075 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objType = |
| 12076 | fusionAlg_P_g.Constant9_Value_jp; |
| 12077 | fusionAlg_B.BusCreator_i.radarObj.radar_39_obj.objMeasFlag = |
| 12078 | fusionAlg_P_g.Constant10_Value_o4; |
| 12079 | |
| 12080 | /* Selector: '<S13>/Selector39' incorporates: |
| 12081 | * Constant: '<S13>/Constant39' |
| 12082 | */ |
| 12083 | fusionAlg_B.Selector39_m = rtu_Radar308_Info_st-> |
| 12084 | leftFrontRadar_General[fusionAlg_P_g.Constant39_Value]; |
| 12085 | |
| 12086 | /* DataTypeConversion: '<S49>/Data Type Conversion' */ |
| 12087 | tmp = (real32_T)floor(fusionAlg_B.Selector39_m.ID); |
| 12088 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12089 | tmp = 0.0F; |
| 12090 | } else { |
| 12091 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 12092 | } |
| 12093 | |
| 12094 | fusionAlg_B.DataTypeConversion_pc = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12095 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12096 | |
| 12097 | /* End of DataTypeConversion: '<S49>/Data Type Conversion' */ |
| 12098 | |
| 12099 | /* Switch: '<S49>/Switch' incorporates: |
| 12100 | * Constant: '<S49>/Constant7' |
| 12101 | * Constant: '<S49>/Constant8' |
| 12102 | */ |
| 12103 | if (fusionAlg_B.DataTypeConversion_pc > fusionAlg_P_g.Switch_Threshold_a3) { |
| 12104 | fusionAlg_B.Switch_kq = fusionAlg_P_g.Constant7_Value_bu; |
| 12105 | } else { |
| 12106 | fusionAlg_B.Switch_kq = fusionAlg_P_g.Constant8_Value_n; |
| 12107 | } |
| 12108 | |
| 12109 | /* End of Switch: '<S49>/Switch' */ |
| 12110 | |
| 12111 | /* DataTypeConversion: '<S49>/Data Type Conversion1' */ |
| 12112 | tmp = (real32_T)floor(fusionAlg_B.Selector39_m.DynProp); |
| 12113 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12114 | tmp = 0.0F; |
| 12115 | } else { |
| 12116 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12117 | } |
| 12118 | |
| 12119 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objMotionPattern = (uint8_T) |
| 12120 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12121 | tmp); |
| 12122 | |
| 12123 | /* End of DataTypeConversion: '<S49>/Data Type Conversion1' */ |
| 12124 | |
| 12125 | /* BusCreator: '<S49>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12126 | * Constant: '<S49>/Constant' |
| 12127 | * Constant: '<S49>/Constant1' |
| 12128 | */ |
| 12129 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.reserved.reserved1 = |
| 12130 | fusionAlg_P_g.Constant_Value_d2i; |
| 12131 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.reserved.reserved0 = |
| 12132 | fusionAlg_P_g.Constant1_Value_iv; |
| 12133 | |
| 12134 | /* BusCreator: '<S49>/Bus Creator1' incorporates: |
| 12135 | * Constant: '<S49>/Constant10' |
| 12136 | * Constant: '<S49>/Constant2' |
| 12137 | * Constant: '<S49>/Constant3' |
| 12138 | * Constant: '<S49>/Constant4' |
| 12139 | * Constant: '<S49>/Constant5' |
| 12140 | * Constant: '<S49>/Constant6' |
| 12141 | * Constant: '<S49>/Constant9' |
| 12142 | */ |
| 12143 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objObstacleProb = |
| 12144 | fusionAlg_B.Selector39_m.RCS; |
| 12145 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objXPos_Stdev = |
| 12146 | fusionAlg_P_g.Constant2_Value_pf; |
| 12147 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objYPos_Stdev = |
| 12148 | fusionAlg_P_g.Constant3_Value_dz; |
| 12149 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objXVelRel_Stdev = |
| 12150 | fusionAlg_P_g.Constant4_Value_p4; |
| 12151 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objXAccRel = |
| 12152 | fusionAlg_P_g.Constant5_Value_b; |
| 12153 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objExstProb = |
| 12154 | fusionAlg_P_g.Constant6_Value_gd; |
| 12155 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objYVelRel = |
| 12156 | fusionAlg_B.Selector39_m.VrelLat; |
| 12157 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objXVelRel = |
| 12158 | fusionAlg_B.Selector39_m.VrelLong; |
| 12159 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objXPos = |
| 12160 | fusionAlg_B.Selector39_m.DistLong; |
| 12161 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objYPos = |
| 12162 | fusionAlg_B.Selector39_m.DistLat; |
| 12163 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objID = |
| 12164 | fusionAlg_B.DataTypeConversion_pc; |
| 12165 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objUpdateFlag = |
| 12166 | fusionAlg_B.Switch_kq; |
| 12167 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objValidFlag = |
| 12168 | fusionAlg_B.Switch_kq; |
| 12169 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objType = |
| 12170 | fusionAlg_P_g.Constant9_Value_ka; |
| 12171 | fusionAlg_B.BusCreator_i.radarObj.radar_40_obj.objMeasFlag = |
| 12172 | fusionAlg_P_g.Constant10_Value_h5; |
| 12173 | |
| 12174 | /* DataTypeConversion: '<S14>/Data Type Conversion' */ |
| 12175 | tmp = (real32_T)floor(rtu_Radar308_Info_st->LeftFrontRadar_Status.tStamp); |
| 12176 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12177 | tmp = 0.0F; |
| 12178 | } else { |
| 12179 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12180 | } |
| 12181 | |
| 12182 | fusionAlg_B.BusCreator_i.radarState.msgAliveCounter = (uint8_T)(tmp < 0.0F ? |
| 12183 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 12184 | |
| 12185 | /* End of DataTypeConversion: '<S14>/Data Type Conversion' */ |
| 12186 | |
| 12187 | /* BusCreator: '<S14>/Bus Creator2' incorporates: |
| 12188 | * Constant: '<S14>/Constant' |
| 12189 | * Constant: '<S14>/Constant1' |
| 12190 | */ |
| 12191 | fusionAlg_B.BusCreator_i.radarState.reservedField.reserved1 = |
| 12192 | fusionAlg_P_g.Constant_Value_bc; |
| 12193 | fusionAlg_B.BusCreator_i.radarState.reservedField.reserved0 = |
| 12194 | fusionAlg_P_g.Constant1_Value_by0; |
| 12195 | |
| 12196 | /* BusCreator: '<S14>/Bus Creator1' incorporates: |
| 12197 | * Constant: '<S14>/Constant10' |
| 12198 | * Constant: '<S14>/Constant11' |
| 12199 | * Constant: '<S14>/Constant2' |
| 12200 | * Constant: '<S14>/Constant3' |
| 12201 | * Constant: '<S14>/Constant4' |
| 12202 | * Constant: '<S14>/Constant5' |
| 12203 | * Constant: '<S14>/Constant6' |
| 12204 | * Constant: '<S14>/Constant7' |
| 12205 | * Constant: '<S14>/Constant8' |
| 12206 | * Constant: '<S14>/Constant9' |
| 12207 | */ |
| 12208 | fusionAlg_B.BusCreator_i.radarState.hostYaw = fusionAlg_P_g.Constant2_Value_hw; |
| 12209 | fusionAlg_B.BusCreator_i.radarState.hostSpeed = |
| 12210 | fusionAlg_P_g.Constant3_Value_k; |
| 12211 | fusionAlg_B.BusCreator_i.radarState.timeStamp = |
| 12212 | fusionAlg_P_g.Constant4_Value_g3; |
| 12213 | fusionAlg_B.BusCreator_i.radarState.statusHWErr = |
| 12214 | fusionAlg_P_g.Constant5_Value_pvk; |
| 12215 | fusionAlg_B.BusCreator_i.radarState.statusBlkProg = |
| 12216 | fusionAlg_P_g.Constant6_Value_hx; |
| 12217 | fusionAlg_B.BusCreator_i.radarState.statusMisAlign = |
| 12218 | fusionAlg_P_g.Constant7_Value_hx; |
| 12219 | fusionAlg_B.BusCreator_i.radarState.sGUFail = fusionAlg_P_g.Constant8_Value_d4; |
| 12220 | fusionAlg_B.BusCreator_i.radarState.measEnabled = |
| 12221 | fusionAlg_P_g.Constant9_Value_oh; |
| 12222 | fusionAlg_B.BusCreator_i.radarState.latency = |
| 12223 | fusionAlg_P_g.Constant10_Value_bk; |
| 12224 | fusionAlg_B.BusCreator_i.radarState.msgCheckSum = |
| 12225 | fusionAlg_P_g.Constant11_Value_m; |
| 12226 | |
| 12227 | /* BusCreator: '<S9>/Bus Creator1' incorporates: |
| 12228 | * Constant: '<S9>/Constant' |
| 12229 | * Constant: '<S9>/Constant1' |
| 12230 | */ |
| 12231 | fusionAlg_B.BusCreator_i.reserved.reserved0 = fusionAlg_P_g.Constant_Value_nn; |
| 12232 | fusionAlg_B.BusCreator_i.reserved.reserved1 = fusionAlg_P_g.Constant1_Value_c; |
| 12233 | |
| 12234 | /* BusCreator: '<S9>/Bus Creator' incorporates: |
| 12235 | * Constant: '<S9>/errType' |
| 12236 | * Constant: '<S9>/timestamp' |
| 12237 | */ |
| 12238 | fusionAlg_B.BusCreator_i.timestamp = fusionAlg_P_g.timestamp_Value_h; |
| 12239 | fusionAlg_B.BusCreator_i.errType = fusionAlg_P_g.errType_Value_i; |
| 12240 | |
| 12241 | /* DataTypeConversion: '<S11>/Data Type Conversion1' */ |
| 12242 | tmp = (real32_T)floor(rtu_Radar308_Info_st->rightFrontRadar_Status.Version); |
| 12243 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12244 | tmp = 0.0F; |
| 12245 | } else { |
| 12246 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 12247 | } |
| 12248 | |
| 12249 | fusionAlg_B.BusCreator_a.frameNum = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 12250 | -tmp : (uint32_T)tmp; |
| 12251 | |
| 12252 | /* End of DataTypeConversion: '<S11>/Data Type Conversion1' */ |
| 12253 | |
| 12254 | /* DataTypeConversion: '<S11>/Data Type Conversion' */ |
| 12255 | tmp = (real32_T)floor(rtu_Radar308_Info_st->rightFrontRadar_Status.ObjNum); |
| 12256 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12257 | tmp = 0.0F; |
| 12258 | } else { |
| 12259 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 12260 | } |
| 12261 | |
| 12262 | fusionAlg_B.BusCreator_a.count = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 12263 | -tmp : (uint32_T)tmp; |
| 12264 | |
| 12265 | /* End of DataTypeConversion: '<S11>/Data Type Conversion' */ |
| 12266 | |
| 12267 | /* Selector: '<S97>/Selector' incorporates: |
| 12268 | * Constant: '<S97>/Constant' |
| 12269 | */ |
| 12270 | fusionAlg_B.Selector_o = rtu_Radar308_Info_st-> |
| 12271 | rightFrontRadar_General[fusionAlg_P_g.Constant_Value_i1m]; |
| 12272 | |
| 12273 | /* DataTypeConversion: '<S99>/Data Type Conversion' */ |
| 12274 | tmp = (real32_T)floor(fusionAlg_B.Selector_o.ID); |
| 12275 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12276 | tmp = 0.0F; |
| 12277 | } else { |
| 12278 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 12279 | } |
| 12280 | |
| 12281 | fusionAlg_B.DataTypeConversion_jg = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12282 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12283 | |
| 12284 | /* End of DataTypeConversion: '<S99>/Data Type Conversion' */ |
| 12285 | |
| 12286 | /* Switch: '<S99>/Switch' incorporates: |
| 12287 | * Constant: '<S99>/Constant7' |
| 12288 | * Constant: '<S99>/Constant8' |
| 12289 | */ |
| 12290 | if (fusionAlg_B.DataTypeConversion_jg > fusionAlg_P_g.Switch_Threshold_b3) { |
| 12291 | fusionAlg_B.Switch_lz = fusionAlg_P_g.Constant7_Value_mo; |
| 12292 | } else { |
| 12293 | fusionAlg_B.Switch_lz = fusionAlg_P_g.Constant8_Value_d4k; |
| 12294 | } |
| 12295 | |
| 12296 | /* End of Switch: '<S99>/Switch' */ |
| 12297 | |
| 12298 | /* DataTypeConversion: '<S99>/Data Type Conversion1' */ |
| 12299 | tmp = (real32_T)floor(fusionAlg_B.Selector_o.DynProp); |
| 12300 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12301 | tmp = 0.0F; |
| 12302 | } else { |
| 12303 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12304 | } |
| 12305 | |
| 12306 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objMotionPattern = (uint8_T) |
| 12307 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12308 | tmp); |
| 12309 | |
| 12310 | /* End of DataTypeConversion: '<S99>/Data Type Conversion1' */ |
| 12311 | |
| 12312 | /* BusCreator: '<S99>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12313 | * Constant: '<S99>/Constant' |
| 12314 | * Constant: '<S99>/Constant1' |
| 12315 | */ |
| 12316 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.reserved.reserved1 = |
| 12317 | fusionAlg_P_g.Constant_Value_hvq; |
| 12318 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.reserved.reserved0 = |
| 12319 | fusionAlg_P_g.Constant1_Value_je; |
| 12320 | |
| 12321 | /* BusCreator: '<S99>/Bus Creator1' incorporates: |
| 12322 | * Constant: '<S99>/Constant10' |
| 12323 | * Constant: '<S99>/Constant2' |
| 12324 | * Constant: '<S99>/Constant3' |
| 12325 | * Constant: '<S99>/Constant4' |
| 12326 | * Constant: '<S99>/Constant5' |
| 12327 | * Constant: '<S99>/Constant6' |
| 12328 | * Constant: '<S99>/Constant9' |
| 12329 | */ |
| 12330 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objObstacleProb = |
| 12331 | fusionAlg_B.Selector_o.RCS; |
| 12332 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objXPos_Stdev = |
| 12333 | fusionAlg_P_g.Constant2_Value_af; |
| 12334 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objYPos_Stdev = |
| 12335 | fusionAlg_P_g.Constant3_Value_n3; |
| 12336 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objXVelRel_Stdev = |
| 12337 | fusionAlg_P_g.Constant4_Value_k4; |
| 12338 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objXAccRel = |
| 12339 | fusionAlg_P_g.Constant5_Value_aa; |
| 12340 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objExstProb = |
| 12341 | fusionAlg_P_g.Constant6_Value_pq; |
| 12342 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objYVelRel = |
| 12343 | fusionAlg_B.Selector_o.VrelLat; |
| 12344 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objXVelRel = |
| 12345 | fusionAlg_B.Selector_o.VrelLong; |
| 12346 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objXPos = |
| 12347 | fusionAlg_B.Selector_o.DistLong; |
| 12348 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objYPos = |
| 12349 | fusionAlg_B.Selector_o.DistLat; |
| 12350 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objID = |
| 12351 | fusionAlg_B.DataTypeConversion_jg; |
| 12352 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objUpdateFlag = |
| 12353 | fusionAlg_B.Switch_lz; |
| 12354 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objValidFlag = |
| 12355 | fusionAlg_B.Switch_lz; |
| 12356 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objType = |
| 12357 | fusionAlg_P_g.Constant9_Value_mc; |
| 12358 | fusionAlg_B.BusCreator_a.radarObj.radar_01_obj.objMeasFlag = |
| 12359 | fusionAlg_P_g.Constant10_Value_aa; |
| 12360 | |
| 12361 | /* Selector: '<S97>/Selector1' incorporates: |
| 12362 | * Constant: '<S97>/Constant1' |
| 12363 | */ |
| 12364 | fusionAlg_B.Selector1_du = rtu_Radar308_Info_st-> |
| 12365 | rightFrontRadar_General[fusionAlg_P_g.Constant1_Value_co]; |
| 12366 | |
| 12367 | /* DataTypeConversion: '<S110>/Data Type Conversion' */ |
| 12368 | tmp = (real32_T)floor(fusionAlg_B.Selector1_du.ID); |
| 12369 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12370 | tmp = 0.0F; |
| 12371 | } else { |
| 12372 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 12373 | } |
| 12374 | |
| 12375 | fusionAlg_B.DataTypeConversion_np = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12376 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12377 | |
| 12378 | /* End of DataTypeConversion: '<S110>/Data Type Conversion' */ |
| 12379 | |
| 12380 | /* Switch: '<S110>/Switch' incorporates: |
| 12381 | * Constant: '<S110>/Constant7' |
| 12382 | * Constant: '<S110>/Constant8' |
| 12383 | */ |
| 12384 | if (fusionAlg_B.DataTypeConversion_np > fusionAlg_P_g.Switch_Threshold_eq) { |
| 12385 | fusionAlg_B.Switch_m3 = fusionAlg_P_g.Constant7_Value_cwc; |
| 12386 | } else { |
| 12387 | fusionAlg_B.Switch_m3 = fusionAlg_P_g.Constant8_Value_jt; |
| 12388 | } |
| 12389 | |
| 12390 | /* End of Switch: '<S110>/Switch' */ |
| 12391 | |
| 12392 | /* DataTypeConversion: '<S110>/Data Type Conversion1' */ |
| 12393 | tmp = (real32_T)floor(fusionAlg_B.Selector1_du.DynProp); |
| 12394 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12395 | tmp = 0.0F; |
| 12396 | } else { |
| 12397 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12398 | } |
| 12399 | |
| 12400 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objMotionPattern = (uint8_T) |
| 12401 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12402 | tmp); |
| 12403 | |
| 12404 | /* End of DataTypeConversion: '<S110>/Data Type Conversion1' */ |
| 12405 | |
| 12406 | /* BusCreator: '<S110>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12407 | * Constant: '<S110>/Constant' |
| 12408 | * Constant: '<S110>/Constant1' |
| 12409 | */ |
| 12410 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.reserved.reserved1 = |
| 12411 | fusionAlg_P_g.Constant_Value_nx; |
| 12412 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.reserved.reserved0 = |
| 12413 | fusionAlg_P_g.Constant1_Value_cr; |
| 12414 | |
| 12415 | /* BusCreator: '<S110>/Bus Creator1' incorporates: |
| 12416 | * Constant: '<S110>/Constant10' |
| 12417 | * Constant: '<S110>/Constant2' |
| 12418 | * Constant: '<S110>/Constant3' |
| 12419 | * Constant: '<S110>/Constant4' |
| 12420 | * Constant: '<S110>/Constant5' |
| 12421 | * Constant: '<S110>/Constant6' |
| 12422 | * Constant: '<S110>/Constant9' |
| 12423 | */ |
| 12424 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objObstacleProb = |
| 12425 | fusionAlg_B.Selector1_du.RCS; |
| 12426 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objXPos_Stdev = |
| 12427 | fusionAlg_P_g.Constant2_Value_lj; |
| 12428 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objYPos_Stdev = |
| 12429 | fusionAlg_P_g.Constant3_Value_el; |
| 12430 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objXVelRel_Stdev = |
| 12431 | fusionAlg_P_g.Constant4_Value_pz; |
| 12432 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objXAccRel = |
| 12433 | fusionAlg_P_g.Constant5_Value_bu; |
| 12434 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objExstProb = |
| 12435 | fusionAlg_P_g.Constant6_Value_mi; |
| 12436 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objYVelRel = |
| 12437 | fusionAlg_B.Selector1_du.VrelLat; |
| 12438 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objXVelRel = |
| 12439 | fusionAlg_B.Selector1_du.VrelLong; |
| 12440 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objXPos = |
| 12441 | fusionAlg_B.Selector1_du.DistLong; |
| 12442 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objYPos = |
| 12443 | fusionAlg_B.Selector1_du.DistLat; |
| 12444 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objID = |
| 12445 | fusionAlg_B.DataTypeConversion_np; |
| 12446 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objUpdateFlag = |
| 12447 | fusionAlg_B.Switch_m3; |
| 12448 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objValidFlag = |
| 12449 | fusionAlg_B.Switch_m3; |
| 12450 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objType = |
| 12451 | fusionAlg_P_g.Constant9_Value_jb; |
| 12452 | fusionAlg_B.BusCreator_a.radarObj.radar_02_obj.objMeasFlag = |
| 12453 | fusionAlg_P_g.Constant10_Value_mi; |
| 12454 | |
| 12455 | /* Selector: '<S97>/Selector2' incorporates: |
| 12456 | * Constant: '<S97>/Constant2' |
| 12457 | */ |
| 12458 | fusionAlg_B.Selector2_m = rtu_Radar308_Info_st-> |
| 12459 | rightFrontRadar_General[fusionAlg_P_g.Constant2_Value_ft]; |
| 12460 | |
| 12461 | /* DataTypeConversion: '<S121>/Data Type Conversion' */ |
| 12462 | tmp = (real32_T)floor(fusionAlg_B.Selector2_m.ID); |
| 12463 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12464 | tmp = 0.0F; |
| 12465 | } else { |
| 12466 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 12467 | } |
| 12468 | |
| 12469 | fusionAlg_B.DataTypeConversion_j1 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12470 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12471 | |
| 12472 | /* End of DataTypeConversion: '<S121>/Data Type Conversion' */ |
| 12473 | |
| 12474 | /* Switch: '<S121>/Switch' incorporates: |
| 12475 | * Constant: '<S121>/Constant7' |
| 12476 | * Constant: '<S121>/Constant8' |
| 12477 | */ |
| 12478 | if (fusionAlg_B.DataTypeConversion_j1 > fusionAlg_P_g.Switch_Threshold_ia) { |
| 12479 | fusionAlg_B.Switch_cq = fusionAlg_P_g.Constant7_Value_ff; |
| 12480 | } else { |
| 12481 | fusionAlg_B.Switch_cq = fusionAlg_P_g.Constant8_Value_in; |
| 12482 | } |
| 12483 | |
| 12484 | /* End of Switch: '<S121>/Switch' */ |
| 12485 | |
| 12486 | /* DataTypeConversion: '<S121>/Data Type Conversion1' */ |
| 12487 | tmp = (real32_T)floor(fusionAlg_B.Selector2_m.DynProp); |
| 12488 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12489 | tmp = 0.0F; |
| 12490 | } else { |
| 12491 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12492 | } |
| 12493 | |
| 12494 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objMotionPattern = (uint8_T) |
| 12495 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12496 | tmp); |
| 12497 | |
| 12498 | /* End of DataTypeConversion: '<S121>/Data Type Conversion1' */ |
| 12499 | |
| 12500 | /* BusCreator: '<S121>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12501 | * Constant: '<S121>/Constant' |
| 12502 | * Constant: '<S121>/Constant1' |
| 12503 | */ |
| 12504 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.reserved.reserved1 = |
| 12505 | fusionAlg_P_g.Constant_Value_d3; |
| 12506 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.reserved.reserved0 = |
| 12507 | fusionAlg_P_g.Constant1_Value_k3; |
| 12508 | |
| 12509 | /* BusCreator: '<S121>/Bus Creator1' incorporates: |
| 12510 | * Constant: '<S121>/Constant10' |
| 12511 | * Constant: '<S121>/Constant2' |
| 12512 | * Constant: '<S121>/Constant3' |
| 12513 | * Constant: '<S121>/Constant4' |
| 12514 | * Constant: '<S121>/Constant5' |
| 12515 | * Constant: '<S121>/Constant6' |
| 12516 | * Constant: '<S121>/Constant9' |
| 12517 | */ |
| 12518 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objObstacleProb = |
| 12519 | fusionAlg_B.Selector2_m.RCS; |
| 12520 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objXPos_Stdev = |
| 12521 | fusionAlg_P_g.Constant2_Value_i1; |
| 12522 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objYPos_Stdev = |
| 12523 | fusionAlg_P_g.Constant3_Value_ms; |
| 12524 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objXVelRel_Stdev = |
| 12525 | fusionAlg_P_g.Constant4_Value_o2; |
| 12526 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objXAccRel = |
| 12527 | fusionAlg_P_g.Constant5_Value_go; |
| 12528 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objExstProb = |
| 12529 | fusionAlg_P_g.Constant6_Value_i4; |
| 12530 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objYVelRel = |
| 12531 | fusionAlg_B.Selector2_m.VrelLat; |
| 12532 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objXVelRel = |
| 12533 | fusionAlg_B.Selector2_m.VrelLong; |
| 12534 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objXPos = |
| 12535 | fusionAlg_B.Selector2_m.DistLong; |
| 12536 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objYPos = |
| 12537 | fusionAlg_B.Selector2_m.DistLat; |
| 12538 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objID = |
| 12539 | fusionAlg_B.DataTypeConversion_j1; |
| 12540 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objUpdateFlag = |
| 12541 | fusionAlg_B.Switch_cq; |
| 12542 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objValidFlag = |
| 12543 | fusionAlg_B.Switch_cq; |
| 12544 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objType = |
| 12545 | fusionAlg_P_g.Constant9_Value_kk; |
| 12546 | fusionAlg_B.BusCreator_a.radarObj.radar_03_obj.objMeasFlag = |
| 12547 | fusionAlg_P_g.Constant10_Value_fq; |
| 12548 | |
| 12549 | /* Selector: '<S97>/Selector3' incorporates: |
| 12550 | * Constant: '<S97>/Constant3' |
| 12551 | */ |
| 12552 | fusionAlg_B.Selector3_o = rtu_Radar308_Info_st-> |
| 12553 | rightFrontRadar_General[fusionAlg_P_g.Constant3_Value_nu]; |
| 12554 | |
| 12555 | /* DataTypeConversion: '<S132>/Data Type Conversion' */ |
| 12556 | tmp = (real32_T)floor(fusionAlg_B.Selector3_o.ID); |
| 12557 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12558 | tmp = 0.0F; |
| 12559 | } else { |
| 12560 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 12561 | } |
| 12562 | |
| 12563 | fusionAlg_B.DataTypeConversion_h2 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12564 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12565 | |
| 12566 | /* End of DataTypeConversion: '<S132>/Data Type Conversion' */ |
| 12567 | |
| 12568 | /* Switch: '<S132>/Switch' incorporates: |
| 12569 | * Constant: '<S132>/Constant7' |
| 12570 | * Constant: '<S132>/Constant8' |
| 12571 | */ |
| 12572 | if (fusionAlg_B.DataTypeConversion_h2 > fusionAlg_P_g.Switch_Threshold_au) { |
| 12573 | fusionAlg_B.Switch_gt = fusionAlg_P_g.Constant7_Value_oi; |
| 12574 | } else { |
| 12575 | fusionAlg_B.Switch_gt = fusionAlg_P_g.Constant8_Value_dp; |
| 12576 | } |
| 12577 | |
| 12578 | /* End of Switch: '<S132>/Switch' */ |
| 12579 | |
| 12580 | /* DataTypeConversion: '<S132>/Data Type Conversion1' */ |
| 12581 | tmp = (real32_T)floor(fusionAlg_B.Selector3_o.DynProp); |
| 12582 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12583 | tmp = 0.0F; |
| 12584 | } else { |
| 12585 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12586 | } |
| 12587 | |
| 12588 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objMotionPattern = (uint8_T) |
| 12589 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12590 | tmp); |
| 12591 | |
| 12592 | /* End of DataTypeConversion: '<S132>/Data Type Conversion1' */ |
| 12593 | |
| 12594 | /* BusCreator: '<S132>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12595 | * Constant: '<S132>/Constant' |
| 12596 | * Constant: '<S132>/Constant1' |
| 12597 | */ |
| 12598 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.reserved.reserved1 = |
| 12599 | fusionAlg_P_g.Constant_Value_cz; |
| 12600 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.reserved.reserved0 = |
| 12601 | fusionAlg_P_g.Constant1_Value_fs; |
| 12602 | |
| 12603 | /* BusCreator: '<S132>/Bus Creator1' incorporates: |
| 12604 | * Constant: '<S132>/Constant10' |
| 12605 | * Constant: '<S132>/Constant2' |
| 12606 | * Constant: '<S132>/Constant3' |
| 12607 | * Constant: '<S132>/Constant4' |
| 12608 | * Constant: '<S132>/Constant5' |
| 12609 | * Constant: '<S132>/Constant6' |
| 12610 | * Constant: '<S132>/Constant9' |
| 12611 | */ |
| 12612 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objObstacleProb = |
| 12613 | fusionAlg_B.Selector3_o.RCS; |
| 12614 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objXPos_Stdev = |
| 12615 | fusionAlg_P_g.Constant2_Value_pp4; |
| 12616 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objYPos_Stdev = |
| 12617 | fusionAlg_P_g.Constant3_Value_ho; |
| 12618 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objXVelRel_Stdev = |
| 12619 | fusionAlg_P_g.Constant4_Value_d1; |
| 12620 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objXAccRel = |
| 12621 | fusionAlg_P_g.Constant5_Value_lv; |
| 12622 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objExstProb = |
| 12623 | fusionAlg_P_g.Constant6_Value_gk; |
| 12624 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objYVelRel = |
| 12625 | fusionAlg_B.Selector3_o.VrelLat; |
| 12626 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objXVelRel = |
| 12627 | fusionAlg_B.Selector3_o.VrelLong; |
| 12628 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objXPos = |
| 12629 | fusionAlg_B.Selector3_o.DistLong; |
| 12630 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objYPos = |
| 12631 | fusionAlg_B.Selector3_o.DistLat; |
| 12632 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objID = |
| 12633 | fusionAlg_B.DataTypeConversion_h2; |
| 12634 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objUpdateFlag = |
| 12635 | fusionAlg_B.Switch_gt; |
| 12636 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objValidFlag = |
| 12637 | fusionAlg_B.Switch_gt; |
| 12638 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objType = |
| 12639 | fusionAlg_P_g.Constant9_Value_eb; |
| 12640 | fusionAlg_B.BusCreator_a.radarObj.radar_04_obj.objMeasFlag = |
| 12641 | fusionAlg_P_g.Constant10_Value_ek; |
| 12642 | |
| 12643 | /* Selector: '<S97>/Selector4' incorporates: |
| 12644 | * Constant: '<S97>/Constant4' |
| 12645 | */ |
| 12646 | fusionAlg_B.Selector4_n = rtu_Radar308_Info_st-> |
| 12647 | rightFrontRadar_General[fusionAlg_P_g.Constant4_Value_il]; |
| 12648 | |
| 12649 | /* DataTypeConversion: '<S134>/Data Type Conversion' */ |
| 12650 | tmp = (real32_T)floor(fusionAlg_B.Selector4_n.ID); |
| 12651 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12652 | tmp = 0.0F; |
| 12653 | } else { |
| 12654 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 12655 | } |
| 12656 | |
| 12657 | fusionAlg_B.DataTypeConversion_ll = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12658 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12659 | |
| 12660 | /* End of DataTypeConversion: '<S134>/Data Type Conversion' */ |
| 12661 | |
| 12662 | /* Switch: '<S134>/Switch' incorporates: |
| 12663 | * Constant: '<S134>/Constant7' |
| 12664 | * Constant: '<S134>/Constant8' |
| 12665 | */ |
| 12666 | if (fusionAlg_B.DataTypeConversion_ll > fusionAlg_P_g.Switch_Threshold_n5) { |
| 12667 | fusionAlg_B.Switch_ku = fusionAlg_P_g.Constant7_Value_kh; |
| 12668 | } else { |
| 12669 | fusionAlg_B.Switch_ku = fusionAlg_P_g.Constant8_Value_bm; |
| 12670 | } |
| 12671 | |
| 12672 | /* End of Switch: '<S134>/Switch' */ |
| 12673 | |
| 12674 | /* DataTypeConversion: '<S134>/Data Type Conversion1' */ |
| 12675 | tmp = (real32_T)floor(fusionAlg_B.Selector4_n.DynProp); |
| 12676 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12677 | tmp = 0.0F; |
| 12678 | } else { |
| 12679 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12680 | } |
| 12681 | |
| 12682 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objMotionPattern = (uint8_T) |
| 12683 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12684 | tmp); |
| 12685 | |
| 12686 | /* End of DataTypeConversion: '<S134>/Data Type Conversion1' */ |
| 12687 | |
| 12688 | /* BusCreator: '<S134>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12689 | * Constant: '<S134>/Constant' |
| 12690 | * Constant: '<S134>/Constant1' |
| 12691 | */ |
| 12692 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.reserved.reserved1 = |
| 12693 | fusionAlg_P_g.Constant_Value_pw; |
| 12694 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.reserved.reserved0 = |
| 12695 | fusionAlg_P_g.Constant1_Value_ajm; |
| 12696 | |
| 12697 | /* BusCreator: '<S134>/Bus Creator1' incorporates: |
| 12698 | * Constant: '<S134>/Constant10' |
| 12699 | * Constant: '<S134>/Constant2' |
| 12700 | * Constant: '<S134>/Constant3' |
| 12701 | * Constant: '<S134>/Constant4' |
| 12702 | * Constant: '<S134>/Constant5' |
| 12703 | * Constant: '<S134>/Constant6' |
| 12704 | * Constant: '<S134>/Constant9' |
| 12705 | */ |
| 12706 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objObstacleProb = |
| 12707 | fusionAlg_B.Selector4_n.RCS; |
| 12708 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objXPos_Stdev = |
| 12709 | fusionAlg_P_g.Constant2_Value_hs; |
| 12710 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objYPos_Stdev = |
| 12711 | fusionAlg_P_g.Constant3_Value_j0; |
| 12712 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objXVelRel_Stdev = |
| 12713 | fusionAlg_P_g.Constant4_Value_m; |
| 12714 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objXAccRel = |
| 12715 | fusionAlg_P_g.Constant5_Value_ou; |
| 12716 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objExstProb = |
| 12717 | fusionAlg_P_g.Constant6_Value_fs; |
| 12718 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objYVelRel = |
| 12719 | fusionAlg_B.Selector4_n.VrelLat; |
| 12720 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objXVelRel = |
| 12721 | fusionAlg_B.Selector4_n.VrelLong; |
| 12722 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objXPos = |
| 12723 | fusionAlg_B.Selector4_n.DistLong; |
| 12724 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objYPos = |
| 12725 | fusionAlg_B.Selector4_n.DistLat; |
| 12726 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objID = |
| 12727 | fusionAlg_B.DataTypeConversion_ll; |
| 12728 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objUpdateFlag = |
| 12729 | fusionAlg_B.Switch_ku; |
| 12730 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objValidFlag = |
| 12731 | fusionAlg_B.Switch_ku; |
| 12732 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objType = |
| 12733 | fusionAlg_P_g.Constant9_Value_la; |
| 12734 | fusionAlg_B.BusCreator_a.radarObj.radar_05_obj.objMeasFlag = |
| 12735 | fusionAlg_P_g.Constant10_Value_dw; |
| 12736 | |
| 12737 | /* Selector: '<S97>/Selector5' incorporates: |
| 12738 | * Constant: '<S97>/Constant5' |
| 12739 | */ |
| 12740 | fusionAlg_B.Selector5_f2 = rtu_Radar308_Info_st-> |
| 12741 | rightFrontRadar_General[fusionAlg_P_g.Constant5_Value_db]; |
| 12742 | |
| 12743 | /* DataTypeConversion: '<S135>/Data Type Conversion' */ |
| 12744 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f2.ID); |
| 12745 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12746 | tmp = 0.0F; |
| 12747 | } else { |
| 12748 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 12749 | } |
| 12750 | |
| 12751 | fusionAlg_B.DataTypeConversion_py = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12752 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12753 | |
| 12754 | /* End of DataTypeConversion: '<S135>/Data Type Conversion' */ |
| 12755 | |
| 12756 | /* Switch: '<S135>/Switch' incorporates: |
| 12757 | * Constant: '<S135>/Constant7' |
| 12758 | * Constant: '<S135>/Constant8' |
| 12759 | */ |
| 12760 | if (fusionAlg_B.DataTypeConversion_py > fusionAlg_P_g.Switch_Threshold_c0) { |
| 12761 | fusionAlg_B.Switch_n1 = fusionAlg_P_g.Constant7_Value_dh; |
| 12762 | } else { |
| 12763 | fusionAlg_B.Switch_n1 = fusionAlg_P_g.Constant8_Value_ib; |
| 12764 | } |
| 12765 | |
| 12766 | /* End of Switch: '<S135>/Switch' */ |
| 12767 | |
| 12768 | /* DataTypeConversion: '<S135>/Data Type Conversion1' */ |
| 12769 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f2.DynProp); |
| 12770 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12771 | tmp = 0.0F; |
| 12772 | } else { |
| 12773 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12774 | } |
| 12775 | |
| 12776 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objMotionPattern = (uint8_T) |
| 12777 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12778 | tmp); |
| 12779 | |
| 12780 | /* End of DataTypeConversion: '<S135>/Data Type Conversion1' */ |
| 12781 | |
| 12782 | /* BusCreator: '<S135>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12783 | * Constant: '<S135>/Constant' |
| 12784 | * Constant: '<S135>/Constant1' |
| 12785 | */ |
| 12786 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.reserved.reserved1 = |
| 12787 | fusionAlg_P_g.Constant_Value_bfa; |
| 12788 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.reserved.reserved0 = |
| 12789 | fusionAlg_P_g.Constant1_Value_hy; |
| 12790 | |
| 12791 | /* BusCreator: '<S135>/Bus Creator1' incorporates: |
| 12792 | * Constant: '<S135>/Constant10' |
| 12793 | * Constant: '<S135>/Constant2' |
| 12794 | * Constant: '<S135>/Constant3' |
| 12795 | * Constant: '<S135>/Constant4' |
| 12796 | * Constant: '<S135>/Constant5' |
| 12797 | * Constant: '<S135>/Constant6' |
| 12798 | * Constant: '<S135>/Constant9' |
| 12799 | */ |
| 12800 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objObstacleProb = |
| 12801 | fusionAlg_B.Selector5_f2.RCS; |
| 12802 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objXPos_Stdev = |
| 12803 | fusionAlg_P_g.Constant2_Value_cq; |
| 12804 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objYPos_Stdev = |
| 12805 | fusionAlg_P_g.Constant3_Value_os; |
| 12806 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objXVelRel_Stdev = |
| 12807 | fusionAlg_P_g.Constant4_Value_dm; |
| 12808 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objXAccRel = |
| 12809 | fusionAlg_P_g.Constant5_Value_fl; |
| 12810 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objExstProb = |
| 12811 | fusionAlg_P_g.Constant6_Value_dd; |
| 12812 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objYVelRel = |
| 12813 | fusionAlg_B.Selector5_f2.VrelLat; |
| 12814 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objXVelRel = |
| 12815 | fusionAlg_B.Selector5_f2.VrelLong; |
| 12816 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objXPos = |
| 12817 | fusionAlg_B.Selector5_f2.DistLong; |
| 12818 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objYPos = |
| 12819 | fusionAlg_B.Selector5_f2.DistLat; |
| 12820 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objID = |
| 12821 | fusionAlg_B.DataTypeConversion_py; |
| 12822 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objUpdateFlag = |
| 12823 | fusionAlg_B.Switch_n1; |
| 12824 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objValidFlag = |
| 12825 | fusionAlg_B.Switch_n1; |
| 12826 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objType = |
| 12827 | fusionAlg_P_g.Constant9_Value_fi; |
| 12828 | fusionAlg_B.BusCreator_a.radarObj.radar_06_obj.objMeasFlag = |
| 12829 | fusionAlg_P_g.Constant10_Value_np; |
| 12830 | |
| 12831 | /* Selector: '<S97>/Selector6' incorporates: |
| 12832 | * Constant: '<S97>/Constant6' |
| 12833 | */ |
| 12834 | fusionAlg_B.Selector6_b = rtu_Radar308_Info_st-> |
| 12835 | rightFrontRadar_General[fusionAlg_P_g.Constant6_Value_cf]; |
| 12836 | |
| 12837 | /* DataTypeConversion: '<S136>/Data Type Conversion' */ |
| 12838 | tmp = (real32_T)floor(fusionAlg_B.Selector6_b.ID); |
| 12839 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12840 | tmp = 0.0F; |
| 12841 | } else { |
| 12842 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 12843 | } |
| 12844 | |
| 12845 | fusionAlg_B.DataTypeConversion_d0 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12846 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12847 | |
| 12848 | /* End of DataTypeConversion: '<S136>/Data Type Conversion' */ |
| 12849 | |
| 12850 | /* Switch: '<S136>/Switch' incorporates: |
| 12851 | * Constant: '<S136>/Constant7' |
| 12852 | * Constant: '<S136>/Constant8' |
| 12853 | */ |
| 12854 | if (fusionAlg_B.DataTypeConversion_d0 > fusionAlg_P_g.Switch_Threshold_ai) { |
| 12855 | fusionAlg_B.Switch_k1 = fusionAlg_P_g.Constant7_Value_ic; |
| 12856 | } else { |
| 12857 | fusionAlg_B.Switch_k1 = fusionAlg_P_g.Constant8_Value_nl; |
| 12858 | } |
| 12859 | |
| 12860 | /* End of Switch: '<S136>/Switch' */ |
| 12861 | |
| 12862 | /* DataTypeConversion: '<S136>/Data Type Conversion1' */ |
| 12863 | tmp = (real32_T)floor(fusionAlg_B.Selector6_b.DynProp); |
| 12864 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12865 | tmp = 0.0F; |
| 12866 | } else { |
| 12867 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12868 | } |
| 12869 | |
| 12870 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objMotionPattern = (uint8_T) |
| 12871 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12872 | tmp); |
| 12873 | |
| 12874 | /* End of DataTypeConversion: '<S136>/Data Type Conversion1' */ |
| 12875 | |
| 12876 | /* BusCreator: '<S136>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12877 | * Constant: '<S136>/Constant' |
| 12878 | * Constant: '<S136>/Constant1' |
| 12879 | */ |
| 12880 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.reserved.reserved1 = |
| 12881 | fusionAlg_P_g.Constant_Value_noj; |
| 12882 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.reserved.reserved0 = |
| 12883 | fusionAlg_P_g.Constant1_Value_ox; |
| 12884 | |
| 12885 | /* BusCreator: '<S136>/Bus Creator1' incorporates: |
| 12886 | * Constant: '<S136>/Constant10' |
| 12887 | * Constant: '<S136>/Constant2' |
| 12888 | * Constant: '<S136>/Constant3' |
| 12889 | * Constant: '<S136>/Constant4' |
| 12890 | * Constant: '<S136>/Constant5' |
| 12891 | * Constant: '<S136>/Constant6' |
| 12892 | * Constant: '<S136>/Constant9' |
| 12893 | */ |
| 12894 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objObstacleProb = |
| 12895 | fusionAlg_B.Selector6_b.RCS; |
| 12896 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objXPos_Stdev = |
| 12897 | fusionAlg_P_g.Constant2_Value_cl; |
| 12898 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objYPos_Stdev = |
| 12899 | fusionAlg_P_g.Constant3_Value_ci; |
| 12900 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objXVelRel_Stdev = |
| 12901 | fusionAlg_P_g.Constant4_Value_h3; |
| 12902 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objXAccRel = |
| 12903 | fusionAlg_P_g.Constant5_Value_ozm; |
| 12904 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objExstProb = |
| 12905 | fusionAlg_P_g.Constant6_Value_jv; |
| 12906 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objYVelRel = |
| 12907 | fusionAlg_B.Selector6_b.VrelLat; |
| 12908 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objXVelRel = |
| 12909 | fusionAlg_B.Selector6_b.VrelLong; |
| 12910 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objXPos = |
| 12911 | fusionAlg_B.Selector6_b.DistLong; |
| 12912 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objYPos = |
| 12913 | fusionAlg_B.Selector6_b.DistLat; |
| 12914 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objID = |
| 12915 | fusionAlg_B.DataTypeConversion_d0; |
| 12916 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objUpdateFlag = |
| 12917 | fusionAlg_B.Switch_k1; |
| 12918 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objValidFlag = |
| 12919 | fusionAlg_B.Switch_k1; |
| 12920 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objType = |
| 12921 | fusionAlg_P_g.Constant9_Value_e2; |
| 12922 | fusionAlg_B.BusCreator_a.radarObj.radar_07_obj.objMeasFlag = |
| 12923 | fusionAlg_P_g.Constant10_Value_df; |
| 12924 | |
| 12925 | /* Selector: '<S97>/Selector7' incorporates: |
| 12926 | * Constant: '<S97>/Constant7' |
| 12927 | */ |
| 12928 | fusionAlg_B.Selector7_e = rtu_Radar308_Info_st-> |
| 12929 | rightFrontRadar_General[fusionAlg_P_g.Constant7_Value_d4]; |
| 12930 | |
| 12931 | /* DataTypeConversion: '<S137>/Data Type Conversion' */ |
| 12932 | tmp = (real32_T)floor(fusionAlg_B.Selector7_e.ID); |
| 12933 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12934 | tmp = 0.0F; |
| 12935 | } else { |
| 12936 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 12937 | } |
| 12938 | |
| 12939 | fusionAlg_B.DataTypeConversion_jr = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 12940 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 12941 | |
| 12942 | /* End of DataTypeConversion: '<S137>/Data Type Conversion' */ |
| 12943 | |
| 12944 | /* Switch: '<S137>/Switch' incorporates: |
| 12945 | * Constant: '<S137>/Constant7' |
| 12946 | * Constant: '<S137>/Constant8' |
| 12947 | */ |
| 12948 | if (fusionAlg_B.DataTypeConversion_jr > fusionAlg_P_g.Switch_Threshold_geh) { |
| 12949 | fusionAlg_B.Switch_lc = fusionAlg_P_g.Constant7_Value_j5; |
| 12950 | } else { |
| 12951 | fusionAlg_B.Switch_lc = fusionAlg_P_g.Constant8_Value_k2; |
| 12952 | } |
| 12953 | |
| 12954 | /* End of Switch: '<S137>/Switch' */ |
| 12955 | |
| 12956 | /* DataTypeConversion: '<S137>/Data Type Conversion1' */ |
| 12957 | tmp = (real32_T)floor(fusionAlg_B.Selector7_e.DynProp); |
| 12958 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 12959 | tmp = 0.0F; |
| 12960 | } else { |
| 12961 | tmp = (real32_T)fmod(tmp, 256.0); |
| 12962 | } |
| 12963 | |
| 12964 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objMotionPattern = (uint8_T) |
| 12965 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 12966 | tmp); |
| 12967 | |
| 12968 | /* End of DataTypeConversion: '<S137>/Data Type Conversion1' */ |
| 12969 | |
| 12970 | /* BusCreator: '<S137>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 12971 | * Constant: '<S137>/Constant' |
| 12972 | * Constant: '<S137>/Constant1' |
| 12973 | */ |
| 12974 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.reserved.reserved1 = |
| 12975 | fusionAlg_P_g.Constant_Value_aob; |
| 12976 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.reserved.reserved0 = |
| 12977 | fusionAlg_P_g.Constant1_Value_g3; |
| 12978 | |
| 12979 | /* BusCreator: '<S137>/Bus Creator1' incorporates: |
| 12980 | * Constant: '<S137>/Constant10' |
| 12981 | * Constant: '<S137>/Constant2' |
| 12982 | * Constant: '<S137>/Constant3' |
| 12983 | * Constant: '<S137>/Constant4' |
| 12984 | * Constant: '<S137>/Constant5' |
| 12985 | * Constant: '<S137>/Constant6' |
| 12986 | * Constant: '<S137>/Constant9' |
| 12987 | */ |
| 12988 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objObstacleProb = |
| 12989 | fusionAlg_B.Selector7_e.RCS; |
| 12990 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objXPos_Stdev = |
| 12991 | fusionAlg_P_g.Constant2_Value_em; |
| 12992 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objYPos_Stdev = |
| 12993 | fusionAlg_P_g.Constant3_Value_eg; |
| 12994 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objXVelRel_Stdev = |
| 12995 | fusionAlg_P_g.Constant4_Value_hb; |
| 12996 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objXAccRel = |
| 12997 | fusionAlg_P_g.Constant5_Value_evs; |
| 12998 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objExstProb = |
| 12999 | fusionAlg_P_g.Constant6_Value_pp; |
| 13000 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objYVelRel = |
| 13001 | fusionAlg_B.Selector7_e.VrelLat; |
| 13002 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objXVelRel = |
| 13003 | fusionAlg_B.Selector7_e.VrelLong; |
| 13004 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objXPos = |
| 13005 | fusionAlg_B.Selector7_e.DistLong; |
| 13006 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objYPos = |
| 13007 | fusionAlg_B.Selector7_e.DistLat; |
| 13008 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objID = |
| 13009 | fusionAlg_B.DataTypeConversion_jr; |
| 13010 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objUpdateFlag = |
| 13011 | fusionAlg_B.Switch_lc; |
| 13012 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objValidFlag = |
| 13013 | fusionAlg_B.Switch_lc; |
| 13014 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objType = |
| 13015 | fusionAlg_P_g.Constant9_Value_am; |
| 13016 | fusionAlg_B.BusCreator_a.radarObj.radar_08_obj.objMeasFlag = |
| 13017 | fusionAlg_P_g.Constant10_Value_jn; |
| 13018 | |
| 13019 | /* Selector: '<S97>/Selector8' incorporates: |
| 13020 | * Constant: '<S97>/Constant8' |
| 13021 | */ |
| 13022 | fusionAlg_B.Selector8_f = rtu_Radar308_Info_st-> |
| 13023 | rightFrontRadar_General[fusionAlg_P_g.Constant8_Value_fv]; |
| 13024 | |
| 13025 | /* DataTypeConversion: '<S138>/Data Type Conversion' */ |
| 13026 | tmp = (real32_T)floor(fusionAlg_B.Selector8_f.ID); |
| 13027 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13028 | tmp = 0.0F; |
| 13029 | } else { |
| 13030 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13031 | } |
| 13032 | |
| 13033 | fusionAlg_B.DataTypeConversion_h5 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13034 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13035 | |
| 13036 | /* End of DataTypeConversion: '<S138>/Data Type Conversion' */ |
| 13037 | |
| 13038 | /* Switch: '<S138>/Switch' incorporates: |
| 13039 | * Constant: '<S138>/Constant7' |
| 13040 | * Constant: '<S138>/Constant8' |
| 13041 | */ |
| 13042 | if (fusionAlg_B.DataTypeConversion_h5 > fusionAlg_P_g.Switch_Threshold_dl) { |
| 13043 | fusionAlg_B.Switch_mh = fusionAlg_P_g.Constant7_Value_bd; |
| 13044 | } else { |
| 13045 | fusionAlg_B.Switch_mh = fusionAlg_P_g.Constant8_Value_jh; |
| 13046 | } |
| 13047 | |
| 13048 | /* End of Switch: '<S138>/Switch' */ |
| 13049 | |
| 13050 | /* DataTypeConversion: '<S138>/Data Type Conversion1' */ |
| 13051 | tmp = (real32_T)floor(fusionAlg_B.Selector8_f.DynProp); |
| 13052 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13053 | tmp = 0.0F; |
| 13054 | } else { |
| 13055 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13056 | } |
| 13057 | |
| 13058 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objMotionPattern = (uint8_T) |
| 13059 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13060 | tmp); |
| 13061 | |
| 13062 | /* End of DataTypeConversion: '<S138>/Data Type Conversion1' */ |
| 13063 | |
| 13064 | /* BusCreator: '<S138>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13065 | * Constant: '<S138>/Constant' |
| 13066 | * Constant: '<S138>/Constant1' |
| 13067 | */ |
| 13068 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.reserved.reserved1 = |
| 13069 | fusionAlg_P_g.Constant_Value_bp; |
| 13070 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.reserved.reserved0 = |
| 13071 | fusionAlg_P_g.Constant1_Value_be; |
| 13072 | |
| 13073 | /* BusCreator: '<S138>/Bus Creator1' incorporates: |
| 13074 | * Constant: '<S138>/Constant10' |
| 13075 | * Constant: '<S138>/Constant2' |
| 13076 | * Constant: '<S138>/Constant3' |
| 13077 | * Constant: '<S138>/Constant4' |
| 13078 | * Constant: '<S138>/Constant5' |
| 13079 | * Constant: '<S138>/Constant6' |
| 13080 | * Constant: '<S138>/Constant9' |
| 13081 | */ |
| 13082 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objObstacleProb = |
| 13083 | fusionAlg_B.Selector8_f.RCS; |
| 13084 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objXPos_Stdev = |
| 13085 | fusionAlg_P_g.Constant2_Value_oi; |
| 13086 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objYPos_Stdev = |
| 13087 | fusionAlg_P_g.Constant3_Value_ov; |
| 13088 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objXVelRel_Stdev = |
| 13089 | fusionAlg_P_g.Constant4_Value_me; |
| 13090 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objXAccRel = |
| 13091 | fusionAlg_P_g.Constant5_Value_ls; |
| 13092 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objExstProb = |
| 13093 | fusionAlg_P_g.Constant6_Value_iss; |
| 13094 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objYVelRel = |
| 13095 | fusionAlg_B.Selector8_f.VrelLat; |
| 13096 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objXVelRel = |
| 13097 | fusionAlg_B.Selector8_f.VrelLong; |
| 13098 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objXPos = |
| 13099 | fusionAlg_B.Selector8_f.DistLong; |
| 13100 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objYPos = |
| 13101 | fusionAlg_B.Selector8_f.DistLat; |
| 13102 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objID = |
| 13103 | fusionAlg_B.DataTypeConversion_h5; |
| 13104 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objUpdateFlag = |
| 13105 | fusionAlg_B.Switch_mh; |
| 13106 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objValidFlag = |
| 13107 | fusionAlg_B.Switch_mh; |
| 13108 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objType = |
| 13109 | fusionAlg_P_g.Constant9_Value_ea; |
| 13110 | fusionAlg_B.BusCreator_a.radarObj.radar_09_obj.objMeasFlag = |
| 13111 | fusionAlg_P_g.Constant10_Value_c; |
| 13112 | |
| 13113 | /* Selector: '<S97>/Selector9' incorporates: |
| 13114 | * Constant: '<S97>/Constant9' |
| 13115 | */ |
| 13116 | fusionAlg_B.Selector9_ju = rtu_Radar308_Info_st-> |
| 13117 | rightFrontRadar_General[fusionAlg_P_g.Constant9_Value_gk]; |
| 13118 | |
| 13119 | /* DataTypeConversion: '<S100>/Data Type Conversion' */ |
| 13120 | tmp = (real32_T)floor(fusionAlg_B.Selector9_ju.ID); |
| 13121 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13122 | tmp = 0.0F; |
| 13123 | } else { |
| 13124 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13125 | } |
| 13126 | |
| 13127 | fusionAlg_B.DataTypeConversion_m1 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13128 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13129 | |
| 13130 | /* End of DataTypeConversion: '<S100>/Data Type Conversion' */ |
| 13131 | |
| 13132 | /* Switch: '<S100>/Switch' incorporates: |
| 13133 | * Constant: '<S100>/Constant7' |
| 13134 | * Constant: '<S100>/Constant8' |
| 13135 | */ |
| 13136 | if (fusionAlg_B.DataTypeConversion_m1 > fusionAlg_P_g.Switch_Threshold_jw) { |
| 13137 | fusionAlg_B.Switch_mt = fusionAlg_P_g.Constant7_Value_hk; |
| 13138 | } else { |
| 13139 | fusionAlg_B.Switch_mt = fusionAlg_P_g.Constant8_Value_od; |
| 13140 | } |
| 13141 | |
| 13142 | /* End of Switch: '<S100>/Switch' */ |
| 13143 | |
| 13144 | /* DataTypeConversion: '<S100>/Data Type Conversion1' */ |
| 13145 | tmp = (real32_T)floor(fusionAlg_B.Selector9_ju.DynProp); |
| 13146 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13147 | tmp = 0.0F; |
| 13148 | } else { |
| 13149 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13150 | } |
| 13151 | |
| 13152 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objMotionPattern = (uint8_T) |
| 13153 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13154 | tmp); |
| 13155 | |
| 13156 | /* End of DataTypeConversion: '<S100>/Data Type Conversion1' */ |
| 13157 | |
| 13158 | /* BusCreator: '<S100>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13159 | * Constant: '<S100>/Constant' |
| 13160 | * Constant: '<S100>/Constant1' |
| 13161 | */ |
| 13162 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.reserved.reserved1 = |
| 13163 | fusionAlg_P_g.Constant_Value_oo; |
| 13164 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.reserved.reserved0 = |
| 13165 | fusionAlg_P_g.Constant1_Value_css; |
| 13166 | |
| 13167 | /* BusCreator: '<S100>/Bus Creator1' incorporates: |
| 13168 | * Constant: '<S100>/Constant10' |
| 13169 | * Constant: '<S100>/Constant2' |
| 13170 | * Constant: '<S100>/Constant3' |
| 13171 | * Constant: '<S100>/Constant4' |
| 13172 | * Constant: '<S100>/Constant5' |
| 13173 | * Constant: '<S100>/Constant6' |
| 13174 | * Constant: '<S100>/Constant9' |
| 13175 | */ |
| 13176 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objObstacleProb = |
| 13177 | fusionAlg_B.Selector9_ju.RCS; |
| 13178 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objXPos_Stdev = |
| 13179 | fusionAlg_P_g.Constant2_Value_aq; |
| 13180 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objYPos_Stdev = |
| 13181 | fusionAlg_P_g.Constant3_Value_jk; |
| 13182 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objXVelRel_Stdev = |
| 13183 | fusionAlg_P_g.Constant4_Value_iw; |
| 13184 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objXAccRel = |
| 13185 | fusionAlg_P_g.Constant5_Value_fp; |
| 13186 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objExstProb = |
| 13187 | fusionAlg_P_g.Constant6_Value_gy; |
| 13188 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objYVelRel = |
| 13189 | fusionAlg_B.Selector9_ju.VrelLat; |
| 13190 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objXVelRel = |
| 13191 | fusionAlg_B.Selector9_ju.VrelLong; |
| 13192 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objXPos = |
| 13193 | fusionAlg_B.Selector9_ju.DistLong; |
| 13194 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objYPos = |
| 13195 | fusionAlg_B.Selector9_ju.DistLat; |
| 13196 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objID = |
| 13197 | fusionAlg_B.DataTypeConversion_m1; |
| 13198 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objUpdateFlag = |
| 13199 | fusionAlg_B.Switch_mt; |
| 13200 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objValidFlag = |
| 13201 | fusionAlg_B.Switch_mt; |
| 13202 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objType = |
| 13203 | fusionAlg_P_g.Constant9_Value_ob; |
| 13204 | fusionAlg_B.BusCreator_a.radarObj.radar_10_obj.objMeasFlag = |
| 13205 | fusionAlg_P_g.Constant10_Value_jn0; |
| 13206 | |
| 13207 | /* Selector: '<S97>/Selector10' incorporates: |
| 13208 | * Constant: '<S97>/Constant10' |
| 13209 | */ |
| 13210 | fusionAlg_B.Selector10_g = rtu_Radar308_Info_st-> |
| 13211 | rightFrontRadar_General[fusionAlg_P_g.Constant10_Value_ca]; |
| 13212 | |
| 13213 | /* DataTypeConversion: '<S101>/Data Type Conversion' */ |
| 13214 | tmp = (real32_T)floor(fusionAlg_B.Selector10_g.ID); |
| 13215 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13216 | tmp = 0.0F; |
| 13217 | } else { |
| 13218 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13219 | } |
| 13220 | |
| 13221 | fusionAlg_B.DataTypeConversion_fbw = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 13222 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13223 | |
| 13224 | /* End of DataTypeConversion: '<S101>/Data Type Conversion' */ |
| 13225 | |
| 13226 | /* Switch: '<S101>/Switch' incorporates: |
| 13227 | * Constant: '<S101>/Constant7' |
| 13228 | * Constant: '<S101>/Constant8' |
| 13229 | */ |
| 13230 | if (fusionAlg_B.DataTypeConversion_fbw > fusionAlg_P_g.Switch_Threshold_hs) { |
| 13231 | fusionAlg_B.Switch_gn = fusionAlg_P_g.Constant7_Value_dr; |
| 13232 | } else { |
| 13233 | fusionAlg_B.Switch_gn = fusionAlg_P_g.Constant8_Value_bl; |
| 13234 | } |
| 13235 | |
| 13236 | /* End of Switch: '<S101>/Switch' */ |
| 13237 | |
| 13238 | /* DataTypeConversion: '<S101>/Data Type Conversion1' */ |
| 13239 | tmp = (real32_T)floor(fusionAlg_B.Selector10_g.DynProp); |
| 13240 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13241 | tmp = 0.0F; |
| 13242 | } else { |
| 13243 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13244 | } |
| 13245 | |
| 13246 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objMotionPattern = (uint8_T) |
| 13247 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13248 | tmp); |
| 13249 | |
| 13250 | /* End of DataTypeConversion: '<S101>/Data Type Conversion1' */ |
| 13251 | |
| 13252 | /* BusCreator: '<S101>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13253 | * Constant: '<S101>/Constant' |
| 13254 | * Constant: '<S101>/Constant1' |
| 13255 | */ |
| 13256 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.reserved.reserved1 = |
| 13257 | fusionAlg_P_g.Constant_Value_om; |
| 13258 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.reserved.reserved0 = |
| 13259 | fusionAlg_P_g.Constant1_Value_bfg; |
| 13260 | |
| 13261 | /* BusCreator: '<S101>/Bus Creator1' incorporates: |
| 13262 | * Constant: '<S101>/Constant10' |
| 13263 | * Constant: '<S101>/Constant2' |
| 13264 | * Constant: '<S101>/Constant3' |
| 13265 | * Constant: '<S101>/Constant4' |
| 13266 | * Constant: '<S101>/Constant5' |
| 13267 | * Constant: '<S101>/Constant6' |
| 13268 | * Constant: '<S101>/Constant9' |
| 13269 | */ |
| 13270 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objObstacleProb = |
| 13271 | fusionAlg_B.Selector10_g.RCS; |
| 13272 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objXPos_Stdev = |
| 13273 | fusionAlg_P_g.Constant2_Value_er; |
| 13274 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objYPos_Stdev = |
| 13275 | fusionAlg_P_g.Constant3_Value_iz; |
| 13276 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objXVelRel_Stdev = |
| 13277 | fusionAlg_P_g.Constant4_Value_gy; |
| 13278 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objXAccRel = |
| 13279 | fusionAlg_P_g.Constant5_Value_dj; |
| 13280 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objExstProb = |
| 13281 | fusionAlg_P_g.Constant6_Value_l5; |
| 13282 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objYVelRel = |
| 13283 | fusionAlg_B.Selector10_g.VrelLat; |
| 13284 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objXVelRel = |
| 13285 | fusionAlg_B.Selector10_g.VrelLong; |
| 13286 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objXPos = |
| 13287 | fusionAlg_B.Selector10_g.DistLong; |
| 13288 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objYPos = |
| 13289 | fusionAlg_B.Selector10_g.DistLat; |
| 13290 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objID = |
| 13291 | fusionAlg_B.DataTypeConversion_fbw; |
| 13292 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objUpdateFlag = |
| 13293 | fusionAlg_B.Switch_gn; |
| 13294 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objValidFlag = |
| 13295 | fusionAlg_B.Switch_gn; |
| 13296 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objType = |
| 13297 | fusionAlg_P_g.Constant9_Value_kai; |
| 13298 | fusionAlg_B.BusCreator_a.radarObj.radar_11_obj.objMeasFlag = |
| 13299 | fusionAlg_P_g.Constant10_Value_ho; |
| 13300 | |
| 13301 | /* Selector: '<S97>/Selector11' incorporates: |
| 13302 | * Constant: '<S97>/Constant11' |
| 13303 | */ |
| 13304 | fusionAlg_B.Selector11_c = rtu_Radar308_Info_st-> |
| 13305 | rightFrontRadar_General[fusionAlg_P_g.Constant11_Value_n]; |
| 13306 | |
| 13307 | /* DataTypeConversion: '<S102>/Data Type Conversion' */ |
| 13308 | tmp = (real32_T)floor(fusionAlg_B.Selector11_c.ID); |
| 13309 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13310 | tmp = 0.0F; |
| 13311 | } else { |
| 13312 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13313 | } |
| 13314 | |
| 13315 | fusionAlg_B.DataTypeConversion_of = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13316 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13317 | |
| 13318 | /* End of DataTypeConversion: '<S102>/Data Type Conversion' */ |
| 13319 | |
| 13320 | /* Switch: '<S102>/Switch' incorporates: |
| 13321 | * Constant: '<S102>/Constant7' |
| 13322 | * Constant: '<S102>/Constant8' |
| 13323 | */ |
| 13324 | if (fusionAlg_B.DataTypeConversion_of > fusionAlg_P_g.Switch_Threshold_f) { |
| 13325 | fusionAlg_B.Switch_mhm = fusionAlg_P_g.Constant7_Value_o2; |
| 13326 | } else { |
| 13327 | fusionAlg_B.Switch_mhm = fusionAlg_P_g.Constant8_Value_a0; |
| 13328 | } |
| 13329 | |
| 13330 | /* End of Switch: '<S102>/Switch' */ |
| 13331 | |
| 13332 | /* DataTypeConversion: '<S102>/Data Type Conversion1' */ |
| 13333 | tmp = (real32_T)floor(fusionAlg_B.Selector11_c.DynProp); |
| 13334 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13335 | tmp = 0.0F; |
| 13336 | } else { |
| 13337 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13338 | } |
| 13339 | |
| 13340 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objMotionPattern = (uint8_T) |
| 13341 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13342 | tmp); |
| 13343 | |
| 13344 | /* End of DataTypeConversion: '<S102>/Data Type Conversion1' */ |
| 13345 | |
| 13346 | /* BusCreator: '<S102>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13347 | * Constant: '<S102>/Constant' |
| 13348 | * Constant: '<S102>/Constant1' |
| 13349 | */ |
| 13350 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.reserved.reserved1 = |
| 13351 | fusionAlg_P_g.Constant_Value_nrl; |
| 13352 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.reserved.reserved0 = |
| 13353 | fusionAlg_P_g.Constant1_Value_jg; |
| 13354 | |
| 13355 | /* BusCreator: '<S102>/Bus Creator1' incorporates: |
| 13356 | * Constant: '<S102>/Constant10' |
| 13357 | * Constant: '<S102>/Constant2' |
| 13358 | * Constant: '<S102>/Constant3' |
| 13359 | * Constant: '<S102>/Constant4' |
| 13360 | * Constant: '<S102>/Constant5' |
| 13361 | * Constant: '<S102>/Constant6' |
| 13362 | * Constant: '<S102>/Constant9' |
| 13363 | */ |
| 13364 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objObstacleProb = |
| 13365 | fusionAlg_B.Selector11_c.RCS; |
| 13366 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objXPos_Stdev = |
| 13367 | fusionAlg_P_g.Constant2_Value_lx; |
| 13368 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objYPos_Stdev = |
| 13369 | fusionAlg_P_g.Constant3_Value_b3; |
| 13370 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objXVelRel_Stdev = |
| 13371 | fusionAlg_P_g.Constant4_Value_n; |
| 13372 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objXAccRel = |
| 13373 | fusionAlg_P_g.Constant5_Value_a3; |
| 13374 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objExstProb = |
| 13375 | fusionAlg_P_g.Constant6_Value_j4; |
| 13376 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objYVelRel = |
| 13377 | fusionAlg_B.Selector11_c.VrelLat; |
| 13378 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objXVelRel = |
| 13379 | fusionAlg_B.Selector11_c.VrelLong; |
| 13380 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objXPos = |
| 13381 | fusionAlg_B.Selector11_c.DistLong; |
| 13382 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objYPos = |
| 13383 | fusionAlg_B.Selector11_c.DistLat; |
| 13384 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objID = |
| 13385 | fusionAlg_B.DataTypeConversion_of; |
| 13386 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objUpdateFlag = |
| 13387 | fusionAlg_B.Switch_mhm; |
| 13388 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objValidFlag = |
| 13389 | fusionAlg_B.Switch_mhm; |
| 13390 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objType = |
| 13391 | fusionAlg_P_g.Constant9_Value_mcg; |
| 13392 | fusionAlg_B.BusCreator_a.radarObj.radar_12_obj.objMeasFlag = |
| 13393 | fusionAlg_P_g.Constant10_Value_jtf; |
| 13394 | |
| 13395 | /* Selector: '<S97>/Selector12' incorporates: |
| 13396 | * Constant: '<S97>/Constant12' |
| 13397 | */ |
| 13398 | fusionAlg_B.Selector12_l = rtu_Radar308_Info_st-> |
| 13399 | rightFrontRadar_General[fusionAlg_P_g.Constant12_Value_g]; |
| 13400 | |
| 13401 | /* DataTypeConversion: '<S103>/Data Type Conversion' */ |
| 13402 | tmp = (real32_T)floor(fusionAlg_B.Selector12_l.ID); |
| 13403 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13404 | tmp = 0.0F; |
| 13405 | } else { |
| 13406 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13407 | } |
| 13408 | |
| 13409 | fusionAlg_B.DataTypeConversion_lj = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13410 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13411 | |
| 13412 | /* End of DataTypeConversion: '<S103>/Data Type Conversion' */ |
| 13413 | |
| 13414 | /* Switch: '<S103>/Switch' incorporates: |
| 13415 | * Constant: '<S103>/Constant7' |
| 13416 | * Constant: '<S103>/Constant8' |
| 13417 | */ |
| 13418 | if (fusionAlg_B.DataTypeConversion_lj > fusionAlg_P_g.Switch_Threshold_j0) { |
| 13419 | fusionAlg_B.Switch_fy = fusionAlg_P_g.Constant7_Value_n; |
| 13420 | } else { |
| 13421 | fusionAlg_B.Switch_fy = fusionAlg_P_g.Constant8_Value_fk; |
| 13422 | } |
| 13423 | |
| 13424 | /* End of Switch: '<S103>/Switch' */ |
| 13425 | |
| 13426 | /* DataTypeConversion: '<S103>/Data Type Conversion1' */ |
| 13427 | tmp = (real32_T)floor(fusionAlg_B.Selector12_l.DynProp); |
| 13428 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13429 | tmp = 0.0F; |
| 13430 | } else { |
| 13431 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13432 | } |
| 13433 | |
| 13434 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objMotionPattern = (uint8_T) |
| 13435 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13436 | tmp); |
| 13437 | |
| 13438 | /* End of DataTypeConversion: '<S103>/Data Type Conversion1' */ |
| 13439 | |
| 13440 | /* BusCreator: '<S103>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13441 | * Constant: '<S103>/Constant' |
| 13442 | * Constant: '<S103>/Constant1' |
| 13443 | */ |
| 13444 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.reserved.reserved1 = |
| 13445 | fusionAlg_P_g.Constant_Value_asu; |
| 13446 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.reserved.reserved0 = |
| 13447 | fusionAlg_P_g.Constant1_Value_ig; |
| 13448 | |
| 13449 | /* BusCreator: '<S103>/Bus Creator1' incorporates: |
| 13450 | * Constant: '<S103>/Constant10' |
| 13451 | * Constant: '<S103>/Constant2' |
| 13452 | * Constant: '<S103>/Constant3' |
| 13453 | * Constant: '<S103>/Constant4' |
| 13454 | * Constant: '<S103>/Constant5' |
| 13455 | * Constant: '<S103>/Constant6' |
| 13456 | * Constant: '<S103>/Constant9' |
| 13457 | */ |
| 13458 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objObstacleProb = |
| 13459 | fusionAlg_B.Selector12_l.RCS; |
| 13460 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objXPos_Stdev = |
| 13461 | fusionAlg_P_g.Constant2_Value_pb; |
| 13462 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objYPos_Stdev = |
| 13463 | fusionAlg_P_g.Constant3_Value_cn; |
| 13464 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objXVelRel_Stdev = |
| 13465 | fusionAlg_P_g.Constant4_Value_j; |
| 13466 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objXAccRel = |
| 13467 | fusionAlg_P_g.Constant5_Value_ie; |
| 13468 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objExstProb = |
| 13469 | fusionAlg_P_g.Constant6_Value_ds; |
| 13470 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objYVelRel = |
| 13471 | fusionAlg_B.Selector12_l.VrelLat; |
| 13472 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objXVelRel = |
| 13473 | fusionAlg_B.Selector12_l.VrelLong; |
| 13474 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objXPos = |
| 13475 | fusionAlg_B.Selector12_l.DistLong; |
| 13476 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objYPos = |
| 13477 | fusionAlg_B.Selector12_l.DistLat; |
| 13478 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objID = |
| 13479 | fusionAlg_B.DataTypeConversion_lj; |
| 13480 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objUpdateFlag = |
| 13481 | fusionAlg_B.Switch_fy; |
| 13482 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objValidFlag = |
| 13483 | fusionAlg_B.Switch_fy; |
| 13484 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objType = |
| 13485 | fusionAlg_P_g.Constant9_Value_i; |
| 13486 | fusionAlg_B.BusCreator_a.radarObj.radar_13_obj.objMeasFlag = |
| 13487 | fusionAlg_P_g.Constant10_Value_pj; |
| 13488 | |
| 13489 | /* Selector: '<S97>/Selector13' incorporates: |
| 13490 | * Constant: '<S97>/Constant13' |
| 13491 | */ |
| 13492 | fusionAlg_B.Selector13_g = rtu_Radar308_Info_st-> |
| 13493 | rightFrontRadar_General[fusionAlg_P_g.Constant13_Value_i]; |
| 13494 | |
| 13495 | /* DataTypeConversion: '<S104>/Data Type Conversion' */ |
| 13496 | tmp = (real32_T)floor(fusionAlg_B.Selector13_g.ID); |
| 13497 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13498 | tmp = 0.0F; |
| 13499 | } else { |
| 13500 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13501 | } |
| 13502 | |
| 13503 | fusionAlg_B.DataTypeConversion_c4 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13504 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13505 | |
| 13506 | /* End of DataTypeConversion: '<S104>/Data Type Conversion' */ |
| 13507 | |
| 13508 | /* Switch: '<S104>/Switch' incorporates: |
| 13509 | * Constant: '<S104>/Constant7' |
| 13510 | * Constant: '<S104>/Constant8' |
| 13511 | */ |
| 13512 | if (fusionAlg_B.DataTypeConversion_c4 > fusionAlg_P_g.Switch_Threshold_im) { |
| 13513 | fusionAlg_B.Switch_f5 = fusionAlg_P_g.Constant7_Value_ot; |
| 13514 | } else { |
| 13515 | fusionAlg_B.Switch_f5 = fusionAlg_P_g.Constant8_Value_d4x; |
| 13516 | } |
| 13517 | |
| 13518 | /* End of Switch: '<S104>/Switch' */ |
| 13519 | |
| 13520 | /* DataTypeConversion: '<S104>/Data Type Conversion1' */ |
| 13521 | tmp = (real32_T)floor(fusionAlg_B.Selector13_g.DynProp); |
| 13522 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13523 | tmp = 0.0F; |
| 13524 | } else { |
| 13525 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13526 | } |
| 13527 | |
| 13528 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objMotionPattern = (uint8_T) |
| 13529 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13530 | tmp); |
| 13531 | |
| 13532 | /* End of DataTypeConversion: '<S104>/Data Type Conversion1' */ |
| 13533 | |
| 13534 | /* BusCreator: '<S104>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13535 | * Constant: '<S104>/Constant' |
| 13536 | * Constant: '<S104>/Constant1' |
| 13537 | */ |
| 13538 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.reserved.reserved1 = |
| 13539 | fusionAlg_P_g.Constant_Value_cp; |
| 13540 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.reserved.reserved0 = |
| 13541 | fusionAlg_P_g.Constant1_Value_av; |
| 13542 | |
| 13543 | /* BusCreator: '<S104>/Bus Creator1' incorporates: |
| 13544 | * Constant: '<S104>/Constant10' |
| 13545 | * Constant: '<S104>/Constant2' |
| 13546 | * Constant: '<S104>/Constant3' |
| 13547 | * Constant: '<S104>/Constant4' |
| 13548 | * Constant: '<S104>/Constant5' |
| 13549 | * Constant: '<S104>/Constant6' |
| 13550 | * Constant: '<S104>/Constant9' |
| 13551 | */ |
| 13552 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objObstacleProb = |
| 13553 | fusionAlg_B.Selector13_g.RCS; |
| 13554 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objXPos_Stdev = |
| 13555 | fusionAlg_P_g.Constant2_Value_ka; |
| 13556 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objYPos_Stdev = |
| 13557 | fusionAlg_P_g.Constant3_Value_im; |
| 13558 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objXVelRel_Stdev = |
| 13559 | fusionAlg_P_g.Constant4_Value_bj; |
| 13560 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objXAccRel = |
| 13561 | fusionAlg_P_g.Constant5_Value_evd; |
| 13562 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objExstProb = |
| 13563 | fusionAlg_P_g.Constant6_Value_fz; |
| 13564 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objYVelRel = |
| 13565 | fusionAlg_B.Selector13_g.VrelLat; |
| 13566 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objXVelRel = |
| 13567 | fusionAlg_B.Selector13_g.VrelLong; |
| 13568 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objXPos = |
| 13569 | fusionAlg_B.Selector13_g.DistLong; |
| 13570 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objYPos = |
| 13571 | fusionAlg_B.Selector13_g.DistLat; |
| 13572 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objID = |
| 13573 | fusionAlg_B.DataTypeConversion_c4; |
| 13574 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objUpdateFlag = |
| 13575 | fusionAlg_B.Switch_f5; |
| 13576 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objValidFlag = |
| 13577 | fusionAlg_B.Switch_f5; |
| 13578 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objType = |
| 13579 | fusionAlg_P_g.Constant9_Value_jl; |
| 13580 | fusionAlg_B.BusCreator_a.radarObj.radar_14_obj.objMeasFlag = |
| 13581 | fusionAlg_P_g.Constant10_Value_bj; |
| 13582 | |
| 13583 | /* Selector: '<S97>/Selector14' incorporates: |
| 13584 | * Constant: '<S97>/Constant14' |
| 13585 | */ |
| 13586 | fusionAlg_B.Selector14_m = rtu_Radar308_Info_st-> |
| 13587 | rightFrontRadar_General[fusionAlg_P_g.Constant14_Value_d]; |
| 13588 | |
| 13589 | /* DataTypeConversion: '<S105>/Data Type Conversion' */ |
| 13590 | tmp = (real32_T)floor(fusionAlg_B.Selector14_m.ID); |
| 13591 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13592 | tmp = 0.0F; |
| 13593 | } else { |
| 13594 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13595 | } |
| 13596 | |
| 13597 | fusionAlg_B.DataTypeConversion_ds = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13598 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13599 | |
| 13600 | /* End of DataTypeConversion: '<S105>/Data Type Conversion' */ |
| 13601 | |
| 13602 | /* Switch: '<S105>/Switch' incorporates: |
| 13603 | * Constant: '<S105>/Constant7' |
| 13604 | * Constant: '<S105>/Constant8' |
| 13605 | */ |
| 13606 | if (fusionAlg_B.DataTypeConversion_ds > fusionAlg_P_g.Switch_Threshold_ih) { |
| 13607 | fusionAlg_B.Switch_fy1 = fusionAlg_P_g.Constant7_Value_l3; |
| 13608 | } else { |
| 13609 | fusionAlg_B.Switch_fy1 = fusionAlg_P_g.Constant8_Value_nv; |
| 13610 | } |
| 13611 | |
| 13612 | /* End of Switch: '<S105>/Switch' */ |
| 13613 | |
| 13614 | /* DataTypeConversion: '<S105>/Data Type Conversion1' */ |
| 13615 | tmp = (real32_T)floor(fusionAlg_B.Selector14_m.DynProp); |
| 13616 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13617 | tmp = 0.0F; |
| 13618 | } else { |
| 13619 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13620 | } |
| 13621 | |
| 13622 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objMotionPattern = (uint8_T) |
| 13623 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13624 | tmp); |
| 13625 | |
| 13626 | /* End of DataTypeConversion: '<S105>/Data Type Conversion1' */ |
| 13627 | |
| 13628 | /* BusCreator: '<S105>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13629 | * Constant: '<S105>/Constant' |
| 13630 | * Constant: '<S105>/Constant1' |
| 13631 | */ |
| 13632 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.reserved.reserved1 = |
| 13633 | fusionAlg_P_g.Constant_Value_fd; |
| 13634 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.reserved.reserved0 = |
| 13635 | fusionAlg_P_g.Constant1_Value_bv; |
| 13636 | |
| 13637 | /* BusCreator: '<S105>/Bus Creator1' incorporates: |
| 13638 | * Constant: '<S105>/Constant10' |
| 13639 | * Constant: '<S105>/Constant2' |
| 13640 | * Constant: '<S105>/Constant3' |
| 13641 | * Constant: '<S105>/Constant4' |
| 13642 | * Constant: '<S105>/Constant5' |
| 13643 | * Constant: '<S105>/Constant6' |
| 13644 | * Constant: '<S105>/Constant9' |
| 13645 | */ |
| 13646 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objObstacleProb = |
| 13647 | fusionAlg_B.Selector14_m.RCS; |
| 13648 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objXPos_Stdev = |
| 13649 | fusionAlg_P_g.Constant2_Value_i3; |
| 13650 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objYPos_Stdev = |
| 13651 | fusionAlg_P_g.Constant3_Value_pt; |
| 13652 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objXVelRel_Stdev = |
| 13653 | fusionAlg_P_g.Constant4_Value_pq; |
| 13654 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objXAccRel = |
| 13655 | fusionAlg_P_g.Constant5_Value_eb; |
| 13656 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objExstProb = |
| 13657 | fusionAlg_P_g.Constant6_Value_a5; |
| 13658 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objYVelRel = |
| 13659 | fusionAlg_B.Selector14_m.VrelLat; |
| 13660 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objXVelRel = |
| 13661 | fusionAlg_B.Selector14_m.VrelLong; |
| 13662 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objXPos = |
| 13663 | fusionAlg_B.Selector14_m.DistLong; |
| 13664 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objYPos = |
| 13665 | fusionAlg_B.Selector14_m.DistLat; |
| 13666 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objID = |
| 13667 | fusionAlg_B.DataTypeConversion_ds; |
| 13668 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objUpdateFlag = |
| 13669 | fusionAlg_B.Switch_fy1; |
| 13670 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objValidFlag = |
| 13671 | fusionAlg_B.Switch_fy1; |
| 13672 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objType = |
| 13673 | fusionAlg_P_g.Constant9_Value_lm; |
| 13674 | fusionAlg_B.BusCreator_a.radarObj.radar_15_obj.objMeasFlag = |
| 13675 | fusionAlg_P_g.Constant10_Value_fo; |
| 13676 | |
| 13677 | /* Selector: '<S97>/Selector15' incorporates: |
| 13678 | * Constant: '<S97>/Constant15' |
| 13679 | */ |
| 13680 | fusionAlg_B.Selector15_p = rtu_Radar308_Info_st-> |
| 13681 | rightFrontRadar_General[fusionAlg_P_g.Constant15_Value_g]; |
| 13682 | |
| 13683 | /* DataTypeConversion: '<S106>/Data Type Conversion' */ |
| 13684 | tmp = (real32_T)floor(fusionAlg_B.Selector15_p.ID); |
| 13685 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13686 | tmp = 0.0F; |
| 13687 | } else { |
| 13688 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13689 | } |
| 13690 | |
| 13691 | fusionAlg_B.DataTypeConversion_fm = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13692 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13693 | |
| 13694 | /* End of DataTypeConversion: '<S106>/Data Type Conversion' */ |
| 13695 | |
| 13696 | /* Switch: '<S106>/Switch' incorporates: |
| 13697 | * Constant: '<S106>/Constant7' |
| 13698 | * Constant: '<S106>/Constant8' |
| 13699 | */ |
| 13700 | if (fusionAlg_B.DataTypeConversion_fm > fusionAlg_P_g.Switch_Threshold_c5) { |
| 13701 | fusionAlg_B.Switch_ke = fusionAlg_P_g.Constant7_Value_bnb; |
| 13702 | } else { |
| 13703 | fusionAlg_B.Switch_ke = fusionAlg_P_g.Constant8_Value_nl5; |
| 13704 | } |
| 13705 | |
| 13706 | /* End of Switch: '<S106>/Switch' */ |
| 13707 | |
| 13708 | /* DataTypeConversion: '<S106>/Data Type Conversion1' */ |
| 13709 | tmp = (real32_T)floor(fusionAlg_B.Selector15_p.DynProp); |
| 13710 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13711 | tmp = 0.0F; |
| 13712 | } else { |
| 13713 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13714 | } |
| 13715 | |
| 13716 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objMotionPattern = (uint8_T) |
| 13717 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13718 | tmp); |
| 13719 | |
| 13720 | /* End of DataTypeConversion: '<S106>/Data Type Conversion1' */ |
| 13721 | |
| 13722 | /* BusCreator: '<S106>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13723 | * Constant: '<S106>/Constant' |
| 13724 | * Constant: '<S106>/Constant1' |
| 13725 | */ |
| 13726 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.reserved.reserved1 = |
| 13727 | fusionAlg_P_g.Constant_Value_hb; |
| 13728 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.reserved.reserved0 = |
| 13729 | fusionAlg_P_g.Constant1_Value_nx; |
| 13730 | |
| 13731 | /* BusCreator: '<S106>/Bus Creator1' incorporates: |
| 13732 | * Constant: '<S106>/Constant10' |
| 13733 | * Constant: '<S106>/Constant2' |
| 13734 | * Constant: '<S106>/Constant3' |
| 13735 | * Constant: '<S106>/Constant4' |
| 13736 | * Constant: '<S106>/Constant5' |
| 13737 | * Constant: '<S106>/Constant6' |
| 13738 | * Constant: '<S106>/Constant9' |
| 13739 | */ |
| 13740 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objObstacleProb = |
| 13741 | fusionAlg_B.Selector15_p.RCS; |
| 13742 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objXPos_Stdev = |
| 13743 | fusionAlg_P_g.Constant2_Value_jt; |
| 13744 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objYPos_Stdev = |
| 13745 | fusionAlg_P_g.Constant3_Value_ju; |
| 13746 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objXVelRel_Stdev = |
| 13747 | fusionAlg_P_g.Constant4_Value_lp; |
| 13748 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objXAccRel = |
| 13749 | fusionAlg_P_g.Constant5_Value_jr; |
| 13750 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objExstProb = |
| 13751 | fusionAlg_P_g.Constant6_Value_lo; |
| 13752 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objYVelRel = |
| 13753 | fusionAlg_B.Selector15_p.VrelLat; |
| 13754 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objXVelRel = |
| 13755 | fusionAlg_B.Selector15_p.VrelLong; |
| 13756 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objXPos = |
| 13757 | fusionAlg_B.Selector15_p.DistLong; |
| 13758 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objYPos = |
| 13759 | fusionAlg_B.Selector15_p.DistLat; |
| 13760 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objID = |
| 13761 | fusionAlg_B.DataTypeConversion_fm; |
| 13762 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objUpdateFlag = |
| 13763 | fusionAlg_B.Switch_ke; |
| 13764 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objValidFlag = |
| 13765 | fusionAlg_B.Switch_ke; |
| 13766 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objType = |
| 13767 | fusionAlg_P_g.Constant9_Value_km; |
| 13768 | fusionAlg_B.BusCreator_a.radarObj.radar_16_obj.objMeasFlag = |
| 13769 | fusionAlg_P_g.Constant10_Value_dwf; |
| 13770 | |
| 13771 | /* Selector: '<S97>/Selector16' incorporates: |
| 13772 | * Constant: '<S97>/Constant16' |
| 13773 | */ |
| 13774 | fusionAlg_B.Selector16_i = rtu_Radar308_Info_st-> |
| 13775 | rightFrontRadar_General[fusionAlg_P_g.Constant16_Value_o]; |
| 13776 | |
| 13777 | /* DataTypeConversion: '<S107>/Data Type Conversion' */ |
| 13778 | tmp = (real32_T)floor(fusionAlg_B.Selector16_i.ID); |
| 13779 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13780 | tmp = 0.0F; |
| 13781 | } else { |
| 13782 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13783 | } |
| 13784 | |
| 13785 | fusionAlg_B.DataTypeConversion_ed = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13786 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13787 | |
| 13788 | /* End of DataTypeConversion: '<S107>/Data Type Conversion' */ |
| 13789 | |
| 13790 | /* Switch: '<S107>/Switch' incorporates: |
| 13791 | * Constant: '<S107>/Constant7' |
| 13792 | * Constant: '<S107>/Constant8' |
| 13793 | */ |
| 13794 | if (fusionAlg_B.DataTypeConversion_ed > fusionAlg_P_g.Switch_Threshold_an) { |
| 13795 | fusionAlg_B.Switch_d = fusionAlg_P_g.Constant7_Value_my; |
| 13796 | } else { |
| 13797 | fusionAlg_B.Switch_d = fusionAlg_P_g.Constant8_Value_bt; |
| 13798 | } |
| 13799 | |
| 13800 | /* End of Switch: '<S107>/Switch' */ |
| 13801 | |
| 13802 | /* DataTypeConversion: '<S107>/Data Type Conversion1' */ |
| 13803 | tmp = (real32_T)floor(fusionAlg_B.Selector16_i.DynProp); |
| 13804 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13805 | tmp = 0.0F; |
| 13806 | } else { |
| 13807 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13808 | } |
| 13809 | |
| 13810 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objMotionPattern = (uint8_T) |
| 13811 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13812 | tmp); |
| 13813 | |
| 13814 | /* End of DataTypeConversion: '<S107>/Data Type Conversion1' */ |
| 13815 | |
| 13816 | /* BusCreator: '<S107>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13817 | * Constant: '<S107>/Constant' |
| 13818 | * Constant: '<S107>/Constant1' |
| 13819 | */ |
| 13820 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.reserved.reserved1 = |
| 13821 | fusionAlg_P_g.Constant_Value_dp; |
| 13822 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.reserved.reserved0 = |
| 13823 | fusionAlg_P_g.Constant1_Value_atk; |
| 13824 | |
| 13825 | /* BusCreator: '<S107>/Bus Creator1' incorporates: |
| 13826 | * Constant: '<S107>/Constant10' |
| 13827 | * Constant: '<S107>/Constant2' |
| 13828 | * Constant: '<S107>/Constant3' |
| 13829 | * Constant: '<S107>/Constant4' |
| 13830 | * Constant: '<S107>/Constant5' |
| 13831 | * Constant: '<S107>/Constant6' |
| 13832 | * Constant: '<S107>/Constant9' |
| 13833 | */ |
| 13834 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objObstacleProb = |
| 13835 | fusionAlg_B.Selector16_i.RCS; |
| 13836 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objXPos_Stdev = |
| 13837 | fusionAlg_P_g.Constant2_Value_nx; |
| 13838 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objYPos_Stdev = |
| 13839 | fusionAlg_P_g.Constant3_Value_pnq; |
| 13840 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objXVelRel_Stdev = |
| 13841 | fusionAlg_P_g.Constant4_Value_gw; |
| 13842 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objXAccRel = |
| 13843 | fusionAlg_P_g.Constant5_Value_pr; |
| 13844 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objExstProb = |
| 13845 | fusionAlg_P_g.Constant6_Value_gz; |
| 13846 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objYVelRel = |
| 13847 | fusionAlg_B.Selector16_i.VrelLat; |
| 13848 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objXVelRel = |
| 13849 | fusionAlg_B.Selector16_i.VrelLong; |
| 13850 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objXPos = |
| 13851 | fusionAlg_B.Selector16_i.DistLong; |
| 13852 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objYPos = |
| 13853 | fusionAlg_B.Selector16_i.DistLat; |
| 13854 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objID = |
| 13855 | fusionAlg_B.DataTypeConversion_ed; |
| 13856 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objUpdateFlag = |
| 13857 | fusionAlg_B.Switch_d; |
| 13858 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objValidFlag = |
| 13859 | fusionAlg_B.Switch_d; |
| 13860 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objType = |
| 13861 | fusionAlg_P_g.Constant9_Value_mi; |
| 13862 | fusionAlg_B.BusCreator_a.radarObj.radar_17_obj.objMeasFlag = |
| 13863 | fusionAlg_P_g.Constant10_Value_nj; |
| 13864 | |
| 13865 | /* Selector: '<S97>/Selector24' incorporates: |
| 13866 | * Constant: '<S97>/Constant17' |
| 13867 | */ |
| 13868 | fusionAlg_B.Selector24_e = rtu_Radar308_Info_st-> |
| 13869 | rightFrontRadar_General[fusionAlg_P_g.Constant17_Value_e]; |
| 13870 | |
| 13871 | /* DataTypeConversion: '<S108>/Data Type Conversion' */ |
| 13872 | tmp = (real32_T)floor(fusionAlg_B.Selector24_e.ID); |
| 13873 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13874 | tmp = 0.0F; |
| 13875 | } else { |
| 13876 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13877 | } |
| 13878 | |
| 13879 | fusionAlg_B.DataTypeConversion_gp = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13880 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13881 | |
| 13882 | /* End of DataTypeConversion: '<S108>/Data Type Conversion' */ |
| 13883 | |
| 13884 | /* Switch: '<S108>/Switch' incorporates: |
| 13885 | * Constant: '<S108>/Constant7' |
| 13886 | * Constant: '<S108>/Constant8' |
| 13887 | */ |
| 13888 | if (fusionAlg_B.DataTypeConversion_gp > fusionAlg_P_g.Switch_Threshold_ff) { |
| 13889 | fusionAlg_B.Switch_m1 = fusionAlg_P_g.Constant7_Value_in; |
| 13890 | } else { |
| 13891 | fusionAlg_B.Switch_m1 = fusionAlg_P_g.Constant8_Value_g4; |
| 13892 | } |
| 13893 | |
| 13894 | /* End of Switch: '<S108>/Switch' */ |
| 13895 | |
| 13896 | /* DataTypeConversion: '<S108>/Data Type Conversion1' */ |
| 13897 | tmp = (real32_T)floor(fusionAlg_B.Selector24_e.DynProp); |
| 13898 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13899 | tmp = 0.0F; |
| 13900 | } else { |
| 13901 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13902 | } |
| 13903 | |
| 13904 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objMotionPattern = (uint8_T) |
| 13905 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 13906 | tmp); |
| 13907 | |
| 13908 | /* End of DataTypeConversion: '<S108>/Data Type Conversion1' */ |
| 13909 | |
| 13910 | /* BusCreator: '<S108>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 13911 | * Constant: '<S108>/Constant' |
| 13912 | * Constant: '<S108>/Constant1' |
| 13913 | */ |
| 13914 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.reserved.reserved1 = |
| 13915 | fusionAlg_P_g.Constant_Value_o0p; |
| 13916 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.reserved.reserved0 = |
| 13917 | fusionAlg_P_g.Constant1_Value_fo; |
| 13918 | |
| 13919 | /* BusCreator: '<S108>/Bus Creator1' incorporates: |
| 13920 | * Constant: '<S108>/Constant10' |
| 13921 | * Constant: '<S108>/Constant2' |
| 13922 | * Constant: '<S108>/Constant3' |
| 13923 | * Constant: '<S108>/Constant4' |
| 13924 | * Constant: '<S108>/Constant5' |
| 13925 | * Constant: '<S108>/Constant6' |
| 13926 | * Constant: '<S108>/Constant9' |
| 13927 | */ |
| 13928 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objObstacleProb = |
| 13929 | fusionAlg_B.Selector24_e.RCS; |
| 13930 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objXPos_Stdev = |
| 13931 | fusionAlg_P_g.Constant2_Value_kz; |
| 13932 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objYPos_Stdev = |
| 13933 | fusionAlg_P_g.Constant3_Value_ob; |
| 13934 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objXVelRel_Stdev = |
| 13935 | fusionAlg_P_g.Constant4_Value_pn5; |
| 13936 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objXAccRel = |
| 13937 | fusionAlg_P_g.Constant5_Value_hn; |
| 13938 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objExstProb = |
| 13939 | fusionAlg_P_g.Constant6_Value_e2; |
| 13940 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objYVelRel = |
| 13941 | fusionAlg_B.Selector24_e.VrelLat; |
| 13942 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objXVelRel = |
| 13943 | fusionAlg_B.Selector24_e.VrelLong; |
| 13944 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objXPos = |
| 13945 | fusionAlg_B.Selector24_e.DistLong; |
| 13946 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objYPos = |
| 13947 | fusionAlg_B.Selector24_e.DistLat; |
| 13948 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objID = |
| 13949 | fusionAlg_B.DataTypeConversion_gp; |
| 13950 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objUpdateFlag = |
| 13951 | fusionAlg_B.Switch_m1; |
| 13952 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objValidFlag = |
| 13953 | fusionAlg_B.Switch_m1; |
| 13954 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objType = |
| 13955 | fusionAlg_P_g.Constant9_Value_ic; |
| 13956 | fusionAlg_B.BusCreator_a.radarObj.radar_18_obj.objMeasFlag = |
| 13957 | fusionAlg_P_g.Constant10_Value_ns; |
| 13958 | |
| 13959 | /* Selector: '<S97>/Selector25' incorporates: |
| 13960 | * Constant: '<S97>/Constant18' |
| 13961 | */ |
| 13962 | fusionAlg_B.Selector25_d = rtu_Radar308_Info_st-> |
| 13963 | rightFrontRadar_General[fusionAlg_P_g.Constant18_Value_f]; |
| 13964 | |
| 13965 | /* DataTypeConversion: '<S109>/Data Type Conversion' */ |
| 13966 | tmp = (real32_T)floor(fusionAlg_B.Selector25_d.ID); |
| 13967 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13968 | tmp = 0.0F; |
| 13969 | } else { |
| 13970 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 13971 | } |
| 13972 | |
| 13973 | fusionAlg_B.DataTypeConversion_b4 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 13974 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 13975 | |
| 13976 | /* End of DataTypeConversion: '<S109>/Data Type Conversion' */ |
| 13977 | |
| 13978 | /* Switch: '<S109>/Switch' incorporates: |
| 13979 | * Constant: '<S109>/Constant7' |
| 13980 | * Constant: '<S109>/Constant8' |
| 13981 | */ |
| 13982 | if (fusionAlg_B.DataTypeConversion_b4 > fusionAlg_P_g.Switch_Threshold_kd) { |
| 13983 | fusionAlg_B.Switch_ad = fusionAlg_P_g.Constant7_Value_l5; |
| 13984 | } else { |
| 13985 | fusionAlg_B.Switch_ad = fusionAlg_P_g.Constant8_Value_kn; |
| 13986 | } |
| 13987 | |
| 13988 | /* End of Switch: '<S109>/Switch' */ |
| 13989 | |
| 13990 | /* DataTypeConversion: '<S109>/Data Type Conversion1' */ |
| 13991 | tmp = (real32_T)floor(fusionAlg_B.Selector25_d.DynProp); |
| 13992 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 13993 | tmp = 0.0F; |
| 13994 | } else { |
| 13995 | tmp = (real32_T)fmod(tmp, 256.0); |
| 13996 | } |
| 13997 | |
| 13998 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objMotionPattern = (uint8_T) |
| 13999 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14000 | tmp); |
| 14001 | |
| 14002 | /* End of DataTypeConversion: '<S109>/Data Type Conversion1' */ |
| 14003 | |
| 14004 | /* BusCreator: '<S109>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14005 | * Constant: '<S109>/Constant' |
| 14006 | * Constant: '<S109>/Constant1' |
| 14007 | */ |
| 14008 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.reserved.reserved1 = |
| 14009 | fusionAlg_P_g.Constant_Value_ml; |
| 14010 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.reserved.reserved0 = |
| 14011 | fusionAlg_P_g.Constant1_Value_i0; |
| 14012 | |
| 14013 | /* BusCreator: '<S109>/Bus Creator1' incorporates: |
| 14014 | * Constant: '<S109>/Constant10' |
| 14015 | * Constant: '<S109>/Constant2' |
| 14016 | * Constant: '<S109>/Constant3' |
| 14017 | * Constant: '<S109>/Constant4' |
| 14018 | * Constant: '<S109>/Constant5' |
| 14019 | * Constant: '<S109>/Constant6' |
| 14020 | * Constant: '<S109>/Constant9' |
| 14021 | */ |
| 14022 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objObstacleProb = |
| 14023 | fusionAlg_B.Selector25_d.RCS; |
| 14024 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objXPos_Stdev = |
| 14025 | fusionAlg_P_g.Constant2_Value_f4; |
| 14026 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objYPos_Stdev = |
| 14027 | fusionAlg_P_g.Constant3_Value_cd; |
| 14028 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objXVelRel_Stdev = |
| 14029 | fusionAlg_P_g.Constant4_Value_d3; |
| 14030 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objXAccRel = |
| 14031 | fusionAlg_P_g.Constant5_Value_nm; |
| 14032 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objExstProb = |
| 14033 | fusionAlg_P_g.Constant6_Value_om; |
| 14034 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objYVelRel = |
| 14035 | fusionAlg_B.Selector25_d.VrelLat; |
| 14036 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objXVelRel = |
| 14037 | fusionAlg_B.Selector25_d.VrelLong; |
| 14038 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objXPos = |
| 14039 | fusionAlg_B.Selector25_d.DistLong; |
| 14040 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objYPos = |
| 14041 | fusionAlg_B.Selector25_d.DistLat; |
| 14042 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objID = |
| 14043 | fusionAlg_B.DataTypeConversion_b4; |
| 14044 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objUpdateFlag = |
| 14045 | fusionAlg_B.Switch_ad; |
| 14046 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objValidFlag = |
| 14047 | fusionAlg_B.Switch_ad; |
| 14048 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objType = |
| 14049 | fusionAlg_P_g.Constant9_Value_mu; |
| 14050 | fusionAlg_B.BusCreator_a.radarObj.radar_19_obj.objMeasFlag = |
| 14051 | fusionAlg_P_g.Constant10_Value_nl; |
| 14052 | |
| 14053 | /* Selector: '<S97>/Selector26' incorporates: |
| 14054 | * Constant: '<S97>/Constant19' |
| 14055 | */ |
| 14056 | fusionAlg_B.Selector26_ae = rtu_Radar308_Info_st-> |
| 14057 | rightFrontRadar_General[fusionAlg_P_g.Constant19_Value_f]; |
| 14058 | |
| 14059 | /* DataTypeConversion: '<S111>/Data Type Conversion' */ |
| 14060 | tmp = (real32_T)floor(fusionAlg_B.Selector26_ae.ID); |
| 14061 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14062 | tmp = 0.0F; |
| 14063 | } else { |
| 14064 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14065 | } |
| 14066 | |
| 14067 | fusionAlg_B.DataTypeConversion_ev = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 14068 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14069 | |
| 14070 | /* End of DataTypeConversion: '<S111>/Data Type Conversion' */ |
| 14071 | |
| 14072 | /* Switch: '<S111>/Switch' incorporates: |
| 14073 | * Constant: '<S111>/Constant7' |
| 14074 | * Constant: '<S111>/Constant8' |
| 14075 | */ |
| 14076 | if (fusionAlg_B.DataTypeConversion_ev > fusionAlg_P_g.Switch_Threshold_gy) { |
| 14077 | fusionAlg_B.Switch_kpg = fusionAlg_P_g.Constant7_Value_dre; |
| 14078 | } else { |
| 14079 | fusionAlg_B.Switch_kpg = fusionAlg_P_g.Constant8_Value_d4g; |
| 14080 | } |
| 14081 | |
| 14082 | /* End of Switch: '<S111>/Switch' */ |
| 14083 | |
| 14084 | /* DataTypeConversion: '<S111>/Data Type Conversion1' */ |
| 14085 | tmp = (real32_T)floor(fusionAlg_B.Selector26_ae.DynProp); |
| 14086 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14087 | tmp = 0.0F; |
| 14088 | } else { |
| 14089 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14090 | } |
| 14091 | |
| 14092 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objMotionPattern = (uint8_T) |
| 14093 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14094 | tmp); |
| 14095 | |
| 14096 | /* End of DataTypeConversion: '<S111>/Data Type Conversion1' */ |
| 14097 | |
| 14098 | /* BusCreator: '<S111>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14099 | * Constant: '<S111>/Constant' |
| 14100 | * Constant: '<S111>/Constant1' |
| 14101 | */ |
| 14102 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.reserved.reserved1 = |
| 14103 | fusionAlg_P_g.Constant_Value_ev; |
| 14104 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.reserved.reserved0 = |
| 14105 | fusionAlg_P_g.Constant1_Value_kd; |
| 14106 | |
| 14107 | /* BusCreator: '<S111>/Bus Creator1' incorporates: |
| 14108 | * Constant: '<S111>/Constant10' |
| 14109 | * Constant: '<S111>/Constant2' |
| 14110 | * Constant: '<S111>/Constant3' |
| 14111 | * Constant: '<S111>/Constant4' |
| 14112 | * Constant: '<S111>/Constant5' |
| 14113 | * Constant: '<S111>/Constant6' |
| 14114 | * Constant: '<S111>/Constant9' |
| 14115 | */ |
| 14116 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objObstacleProb = |
| 14117 | fusionAlg_B.Selector26_ae.RCS; |
| 14118 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objXPos_Stdev = |
| 14119 | fusionAlg_P_g.Constant2_Value_dh; |
| 14120 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objYPos_Stdev = |
| 14121 | fusionAlg_P_g.Constant3_Value_dm; |
| 14122 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objXVelRel_Stdev = |
| 14123 | fusionAlg_P_g.Constant4_Value_og; |
| 14124 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objXAccRel = |
| 14125 | fusionAlg_P_g.Constant5_Value_me; |
| 14126 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objExstProb = |
| 14127 | fusionAlg_P_g.Constant6_Value_jd; |
| 14128 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objYVelRel = |
| 14129 | fusionAlg_B.Selector26_ae.VrelLat; |
| 14130 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objXVelRel = |
| 14131 | fusionAlg_B.Selector26_ae.VrelLong; |
| 14132 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objXPos = |
| 14133 | fusionAlg_B.Selector26_ae.DistLong; |
| 14134 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objYPos = |
| 14135 | fusionAlg_B.Selector26_ae.DistLat; |
| 14136 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objID = |
| 14137 | fusionAlg_B.DataTypeConversion_ev; |
| 14138 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objUpdateFlag = |
| 14139 | fusionAlg_B.Switch_kpg; |
| 14140 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objValidFlag = |
| 14141 | fusionAlg_B.Switch_kpg; |
| 14142 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objType = |
| 14143 | fusionAlg_P_g.Constant9_Value_eu; |
| 14144 | fusionAlg_B.BusCreator_a.radarObj.radar_20_obj.objMeasFlag = |
| 14145 | fusionAlg_P_g.Constant10_Value_i0; |
| 14146 | |
| 14147 | /* Selector: '<S97>/Selector27' incorporates: |
| 14148 | * Constant: '<S97>/Constant20' |
| 14149 | */ |
| 14150 | fusionAlg_B.Selector27_f = rtu_Radar308_Info_st-> |
| 14151 | rightFrontRadar_General[fusionAlg_P_g.Constant20_Value_a]; |
| 14152 | |
| 14153 | /* DataTypeConversion: '<S112>/Data Type Conversion' */ |
| 14154 | tmp = (real32_T)floor(fusionAlg_B.Selector27_f.ID); |
| 14155 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14156 | tmp = 0.0F; |
| 14157 | } else { |
| 14158 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14159 | } |
| 14160 | |
| 14161 | fusionAlg_B.DataTypeConversion_cy = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 14162 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14163 | |
| 14164 | /* End of DataTypeConversion: '<S112>/Data Type Conversion' */ |
| 14165 | |
| 14166 | /* Switch: '<S112>/Switch' incorporates: |
| 14167 | * Constant: '<S112>/Constant7' |
| 14168 | * Constant: '<S112>/Constant8' |
| 14169 | */ |
| 14170 | if (fusionAlg_B.DataTypeConversion_cy > fusionAlg_P_g.Switch_Threshold_kj) { |
| 14171 | fusionAlg_B.Switch_ij = fusionAlg_P_g.Constant7_Value_nl; |
| 14172 | } else { |
| 14173 | fusionAlg_B.Switch_ij = fusionAlg_P_g.Constant8_Value_cy; |
| 14174 | } |
| 14175 | |
| 14176 | /* End of Switch: '<S112>/Switch' */ |
| 14177 | |
| 14178 | /* DataTypeConversion: '<S112>/Data Type Conversion1' */ |
| 14179 | tmp = (real32_T)floor(fusionAlg_B.Selector27_f.DynProp); |
| 14180 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14181 | tmp = 0.0F; |
| 14182 | } else { |
| 14183 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14184 | } |
| 14185 | |
| 14186 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objMotionPattern = (uint8_T) |
| 14187 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14188 | tmp); |
| 14189 | |
| 14190 | /* End of DataTypeConversion: '<S112>/Data Type Conversion1' */ |
| 14191 | |
| 14192 | /* BusCreator: '<S112>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14193 | * Constant: '<S112>/Constant' |
| 14194 | * Constant: '<S112>/Constant1' |
| 14195 | */ |
| 14196 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.reserved.reserved1 = |
| 14197 | fusionAlg_P_g.Constant_Value_lou; |
| 14198 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.reserved.reserved0 = |
| 14199 | fusionAlg_P_g.Constant1_Value_box; |
| 14200 | |
| 14201 | /* BusCreator: '<S112>/Bus Creator1' incorporates: |
| 14202 | * Constant: '<S112>/Constant10' |
| 14203 | * Constant: '<S112>/Constant2' |
| 14204 | * Constant: '<S112>/Constant3' |
| 14205 | * Constant: '<S112>/Constant4' |
| 14206 | * Constant: '<S112>/Constant5' |
| 14207 | * Constant: '<S112>/Constant6' |
| 14208 | * Constant: '<S112>/Constant9' |
| 14209 | */ |
| 14210 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objObstacleProb = |
| 14211 | fusionAlg_B.Selector27_f.RCS; |
| 14212 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objXPos_Stdev = |
| 14213 | fusionAlg_P_g.Constant2_Value_o5; |
| 14214 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objYPos_Stdev = |
| 14215 | fusionAlg_P_g.Constant3_Value_aq; |
| 14216 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objXVelRel_Stdev = |
| 14217 | fusionAlg_P_g.Constant4_Value_o1; |
| 14218 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objXAccRel = |
| 14219 | fusionAlg_P_g.Constant5_Value_ha; |
| 14220 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objExstProb = |
| 14221 | fusionAlg_P_g.Constant6_Value_af; |
| 14222 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objYVelRel = |
| 14223 | fusionAlg_B.Selector27_f.VrelLat; |
| 14224 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objXVelRel = |
| 14225 | fusionAlg_B.Selector27_f.VrelLong; |
| 14226 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objXPos = |
| 14227 | fusionAlg_B.Selector27_f.DistLong; |
| 14228 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objYPos = |
| 14229 | fusionAlg_B.Selector27_f.DistLat; |
| 14230 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objID = |
| 14231 | fusionAlg_B.DataTypeConversion_cy; |
| 14232 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objUpdateFlag = |
| 14233 | fusionAlg_B.Switch_ij; |
| 14234 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objValidFlag = |
| 14235 | fusionAlg_B.Switch_ij; |
| 14236 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objType = |
| 14237 | fusionAlg_P_g.Constant9_Value_ebn; |
| 14238 | fusionAlg_B.BusCreator_a.radarObj.radar_21_obj.objMeasFlag = |
| 14239 | fusionAlg_P_g.Constant10_Value_dp; |
| 14240 | |
| 14241 | /* Selector: '<S97>/Selector28' incorporates: |
| 14242 | * Constant: '<S97>/Constant21' |
| 14243 | */ |
| 14244 | fusionAlg_B.Selector28_j5 = rtu_Radar308_Info_st-> |
| 14245 | rightFrontRadar_General[fusionAlg_P_g.Constant21_Value_l]; |
| 14246 | |
| 14247 | /* DataTypeConversion: '<S113>/Data Type Conversion' */ |
| 14248 | tmp = (real32_T)floor(fusionAlg_B.Selector28_j5.ID); |
| 14249 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14250 | tmp = 0.0F; |
| 14251 | } else { |
| 14252 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14253 | } |
| 14254 | |
| 14255 | fusionAlg_B.DataTypeConversion_iw = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 14256 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14257 | |
| 14258 | /* End of DataTypeConversion: '<S113>/Data Type Conversion' */ |
| 14259 | |
| 14260 | /* Switch: '<S113>/Switch' incorporates: |
| 14261 | * Constant: '<S113>/Constant7' |
| 14262 | * Constant: '<S113>/Constant8' |
| 14263 | */ |
| 14264 | if (fusionAlg_B.DataTypeConversion_iw > fusionAlg_P_g.Switch_Threshold_mr) { |
| 14265 | fusionAlg_B.Switch_bz = fusionAlg_P_g.Constant7_Value_nb; |
| 14266 | } else { |
| 14267 | fusionAlg_B.Switch_bz = fusionAlg_P_g.Constant8_Value_cr; |
| 14268 | } |
| 14269 | |
| 14270 | /* End of Switch: '<S113>/Switch' */ |
| 14271 | |
| 14272 | /* DataTypeConversion: '<S113>/Data Type Conversion1' */ |
| 14273 | tmp = (real32_T)floor(fusionAlg_B.Selector28_j5.DynProp); |
| 14274 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14275 | tmp = 0.0F; |
| 14276 | } else { |
| 14277 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14278 | } |
| 14279 | |
| 14280 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objMotionPattern = (uint8_T) |
| 14281 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14282 | tmp); |
| 14283 | |
| 14284 | /* End of DataTypeConversion: '<S113>/Data Type Conversion1' */ |
| 14285 | |
| 14286 | /* BusCreator: '<S113>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14287 | * Constant: '<S113>/Constant' |
| 14288 | * Constant: '<S113>/Constant1' |
| 14289 | */ |
| 14290 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.reserved.reserved1 = |
| 14291 | fusionAlg_P_g.Constant_Value_kl; |
| 14292 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.reserved.reserved0 = |
| 14293 | fusionAlg_P_g.Constant1_Value_k5; |
| 14294 | |
| 14295 | /* BusCreator: '<S113>/Bus Creator1' incorporates: |
| 14296 | * Constant: '<S113>/Constant10' |
| 14297 | * Constant: '<S113>/Constant2' |
| 14298 | * Constant: '<S113>/Constant3' |
| 14299 | * Constant: '<S113>/Constant4' |
| 14300 | * Constant: '<S113>/Constant5' |
| 14301 | * Constant: '<S113>/Constant6' |
| 14302 | * Constant: '<S113>/Constant9' |
| 14303 | */ |
| 14304 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objObstacleProb = |
| 14305 | fusionAlg_B.Selector28_j5.RCS; |
| 14306 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objXPos_Stdev = |
| 14307 | fusionAlg_P_g.Constant2_Value_ks; |
| 14308 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objYPos_Stdev = |
| 14309 | fusionAlg_P_g.Constant3_Value_ms5; |
| 14310 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objXVelRel_Stdev = |
| 14311 | fusionAlg_P_g.Constant4_Value_cu; |
| 14312 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objXAccRel = |
| 14313 | fusionAlg_P_g.Constant5_Value_oc; |
| 14314 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objExstProb = |
| 14315 | fusionAlg_P_g.Constant6_Value_gep; |
| 14316 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objYVelRel = |
| 14317 | fusionAlg_B.Selector28_j5.VrelLat; |
| 14318 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objXVelRel = |
| 14319 | fusionAlg_B.Selector28_j5.VrelLong; |
| 14320 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objXPos = |
| 14321 | fusionAlg_B.Selector28_j5.DistLong; |
| 14322 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objYPos = |
| 14323 | fusionAlg_B.Selector28_j5.DistLat; |
| 14324 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objID = |
| 14325 | fusionAlg_B.DataTypeConversion_iw; |
| 14326 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objUpdateFlag = |
| 14327 | fusionAlg_B.Switch_bz; |
| 14328 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objValidFlag = |
| 14329 | fusionAlg_B.Switch_bz; |
| 14330 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objType = |
| 14331 | fusionAlg_P_g.Constant9_Value_m3; |
| 14332 | fusionAlg_B.BusCreator_a.radarObj.radar_22_obj.objMeasFlag = |
| 14333 | fusionAlg_P_g.Constant10_Value_ig; |
| 14334 | |
| 14335 | /* Selector: '<S97>/Selector29' incorporates: |
| 14336 | * Constant: '<S97>/Constant22' |
| 14337 | */ |
| 14338 | fusionAlg_B.Selector29_l = rtu_Radar308_Info_st-> |
| 14339 | rightFrontRadar_General[fusionAlg_P_g.Constant22_Value_i]; |
| 14340 | |
| 14341 | /* DataTypeConversion: '<S114>/Data Type Conversion' */ |
| 14342 | tmp = (real32_T)floor(fusionAlg_B.Selector29_l.ID); |
| 14343 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14344 | tmp = 0.0F; |
| 14345 | } else { |
| 14346 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14347 | } |
| 14348 | |
| 14349 | fusionAlg_B.DataTypeConversion_jdu = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 14350 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14351 | |
| 14352 | /* End of DataTypeConversion: '<S114>/Data Type Conversion' */ |
| 14353 | |
| 14354 | /* Switch: '<S114>/Switch' incorporates: |
| 14355 | * Constant: '<S114>/Constant7' |
| 14356 | * Constant: '<S114>/Constant8' |
| 14357 | */ |
| 14358 | if (fusionAlg_B.DataTypeConversion_jdu > fusionAlg_P_g.Switch_Threshold_kh) { |
| 14359 | fusionAlg_B.Switch_i5 = fusionAlg_P_g.Constant7_Value_g; |
| 14360 | } else { |
| 14361 | fusionAlg_B.Switch_i5 = fusionAlg_P_g.Constant8_Value_jj; |
| 14362 | } |
| 14363 | |
| 14364 | /* End of Switch: '<S114>/Switch' */ |
| 14365 | |
| 14366 | /* DataTypeConversion: '<S114>/Data Type Conversion1' */ |
| 14367 | tmp = (real32_T)floor(fusionAlg_B.Selector29_l.DynProp); |
| 14368 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14369 | tmp = 0.0F; |
| 14370 | } else { |
| 14371 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14372 | } |
| 14373 | |
| 14374 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objMotionPattern = (uint8_T) |
| 14375 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14376 | tmp); |
| 14377 | |
| 14378 | /* End of DataTypeConversion: '<S114>/Data Type Conversion1' */ |
| 14379 | |
| 14380 | /* BusCreator: '<S114>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14381 | * Constant: '<S114>/Constant' |
| 14382 | * Constant: '<S114>/Constant1' |
| 14383 | */ |
| 14384 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.reserved.reserved1 = |
| 14385 | fusionAlg_P_g.Constant_Value_ee4; |
| 14386 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.reserved.reserved0 = |
| 14387 | fusionAlg_P_g.Constant1_Value_hl4; |
| 14388 | |
| 14389 | /* BusCreator: '<S114>/Bus Creator1' incorporates: |
| 14390 | * Constant: '<S114>/Constant10' |
| 14391 | * Constant: '<S114>/Constant2' |
| 14392 | * Constant: '<S114>/Constant3' |
| 14393 | * Constant: '<S114>/Constant4' |
| 14394 | * Constant: '<S114>/Constant5' |
| 14395 | * Constant: '<S114>/Constant6' |
| 14396 | * Constant: '<S114>/Constant9' |
| 14397 | */ |
| 14398 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objObstacleProb = |
| 14399 | fusionAlg_B.Selector29_l.RCS; |
| 14400 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objXPos_Stdev = |
| 14401 | fusionAlg_P_g.Constant2_Value_a4i; |
| 14402 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objYPos_Stdev = |
| 14403 | fusionAlg_P_g.Constant3_Value_bh; |
| 14404 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objXVelRel_Stdev = |
| 14405 | fusionAlg_P_g.Constant4_Value_dug; |
| 14406 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objXAccRel = |
| 14407 | fusionAlg_P_g.Constant5_Value_ol; |
| 14408 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objExstProb = |
| 14409 | fusionAlg_P_g.Constant6_Value_ju; |
| 14410 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objYVelRel = |
| 14411 | fusionAlg_B.Selector29_l.VrelLat; |
| 14412 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objXVelRel = |
| 14413 | fusionAlg_B.Selector29_l.VrelLong; |
| 14414 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objXPos = |
| 14415 | fusionAlg_B.Selector29_l.DistLong; |
| 14416 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objYPos = |
| 14417 | fusionAlg_B.Selector29_l.DistLat; |
| 14418 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objID = |
| 14419 | fusionAlg_B.DataTypeConversion_jdu; |
| 14420 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objUpdateFlag = |
| 14421 | fusionAlg_B.Switch_i5; |
| 14422 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objValidFlag = |
| 14423 | fusionAlg_B.Switch_i5; |
| 14424 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objType = |
| 14425 | fusionAlg_P_g.Constant9_Value_bh; |
| 14426 | fusionAlg_B.BusCreator_a.radarObj.radar_23_obj.objMeasFlag = |
| 14427 | fusionAlg_P_g.Constant10_Value_hk; |
| 14428 | |
| 14429 | /* Selector: '<S97>/Selector30' incorporates: |
| 14430 | * Constant: '<S97>/Constant23' |
| 14431 | */ |
| 14432 | fusionAlg_B.Selector30_f = rtu_Radar308_Info_st-> |
| 14433 | rightFrontRadar_General[fusionAlg_P_g.Constant23_Value_c]; |
| 14434 | |
| 14435 | /* DataTypeConversion: '<S115>/Data Type Conversion' */ |
| 14436 | tmp = (real32_T)floor(fusionAlg_B.Selector30_f.ID); |
| 14437 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14438 | tmp = 0.0F; |
| 14439 | } else { |
| 14440 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14441 | } |
| 14442 | |
| 14443 | fusionAlg_B.DataTypeConversion_aa1 = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 14444 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14445 | |
| 14446 | /* End of DataTypeConversion: '<S115>/Data Type Conversion' */ |
| 14447 | |
| 14448 | /* Switch: '<S115>/Switch' incorporates: |
| 14449 | * Constant: '<S115>/Constant7' |
| 14450 | * Constant: '<S115>/Constant8' |
| 14451 | */ |
| 14452 | if (fusionAlg_B.DataTypeConversion_aa1 > fusionAlg_P_g.Switch_Threshold_lm) { |
| 14453 | fusionAlg_B.Switch_gv = fusionAlg_P_g.Constant7_Value_me; |
| 14454 | } else { |
| 14455 | fusionAlg_B.Switch_gv = fusionAlg_P_g.Constant8_Value_fe; |
| 14456 | } |
| 14457 | |
| 14458 | /* End of Switch: '<S115>/Switch' */ |
| 14459 | |
| 14460 | /* DataTypeConversion: '<S115>/Data Type Conversion1' */ |
| 14461 | tmp = (real32_T)floor(fusionAlg_B.Selector30_f.DynProp); |
| 14462 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14463 | tmp = 0.0F; |
| 14464 | } else { |
| 14465 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14466 | } |
| 14467 | |
| 14468 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objMotionPattern = (uint8_T) |
| 14469 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14470 | tmp); |
| 14471 | |
| 14472 | /* End of DataTypeConversion: '<S115>/Data Type Conversion1' */ |
| 14473 | |
| 14474 | /* BusCreator: '<S115>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14475 | * Constant: '<S115>/Constant' |
| 14476 | * Constant: '<S115>/Constant1' |
| 14477 | */ |
| 14478 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.reserved.reserved1 = |
| 14479 | fusionAlg_P_g.Constant_Value_md0; |
| 14480 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.reserved.reserved0 = |
| 14481 | fusionAlg_P_g.Constant1_Value_mw; |
| 14482 | |
| 14483 | /* BusCreator: '<S115>/Bus Creator1' incorporates: |
| 14484 | * Constant: '<S115>/Constant10' |
| 14485 | * Constant: '<S115>/Constant2' |
| 14486 | * Constant: '<S115>/Constant3' |
| 14487 | * Constant: '<S115>/Constant4' |
| 14488 | * Constant: '<S115>/Constant5' |
| 14489 | * Constant: '<S115>/Constant6' |
| 14490 | * Constant: '<S115>/Constant9' |
| 14491 | */ |
| 14492 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objObstacleProb = |
| 14493 | fusionAlg_B.Selector30_f.RCS; |
| 14494 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objXPos_Stdev = |
| 14495 | fusionAlg_P_g.Constant2_Value_ia; |
| 14496 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objYPos_Stdev = |
| 14497 | fusionAlg_P_g.Constant3_Value_o1; |
| 14498 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objXVelRel_Stdev = |
| 14499 | fusionAlg_P_g.Constant4_Value_ma; |
| 14500 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objXAccRel = |
| 14501 | fusionAlg_P_g.Constant5_Value_av; |
| 14502 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objExstProb = |
| 14503 | fusionAlg_P_g.Constant6_Value_ge1; |
| 14504 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objYVelRel = |
| 14505 | fusionAlg_B.Selector30_f.VrelLat; |
| 14506 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objXVelRel = |
| 14507 | fusionAlg_B.Selector30_f.VrelLong; |
| 14508 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objXPos = |
| 14509 | fusionAlg_B.Selector30_f.DistLong; |
| 14510 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objYPos = |
| 14511 | fusionAlg_B.Selector30_f.DistLat; |
| 14512 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objID = |
| 14513 | fusionAlg_B.DataTypeConversion_aa1; |
| 14514 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objUpdateFlag = |
| 14515 | fusionAlg_B.Switch_gv; |
| 14516 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objValidFlag = |
| 14517 | fusionAlg_B.Switch_gv; |
| 14518 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objType = |
| 14519 | fusionAlg_P_g.Constant9_Value_ad; |
| 14520 | fusionAlg_B.BusCreator_a.radarObj.radar_24_obj.objMeasFlag = |
| 14521 | fusionAlg_P_g.Constant10_Value_kj; |
| 14522 | |
| 14523 | /* Selector: '<S97>/Selector17' incorporates: |
| 14524 | * Constant: '<S97>/Constant24' |
| 14525 | */ |
| 14526 | fusionAlg_B.Selector17_f = rtu_Radar308_Info_st-> |
| 14527 | rightFrontRadar_General[fusionAlg_P_g.Constant24_Value_p]; |
| 14528 | |
| 14529 | /* DataTypeConversion: '<S116>/Data Type Conversion' */ |
| 14530 | tmp = (real32_T)floor(fusionAlg_B.Selector17_f.ID); |
| 14531 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14532 | tmp = 0.0F; |
| 14533 | } else { |
| 14534 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14535 | } |
| 14536 | |
| 14537 | fusionAlg_B.DataTypeConversion_jg5 = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 14538 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14539 | |
| 14540 | /* End of DataTypeConversion: '<S116>/Data Type Conversion' */ |
| 14541 | |
| 14542 | /* Switch: '<S116>/Switch' incorporates: |
| 14543 | * Constant: '<S116>/Constant7' |
| 14544 | * Constant: '<S116>/Constant8' |
| 14545 | */ |
| 14546 | if (fusionAlg_B.DataTypeConversion_jg5 > fusionAlg_P_g.Switch_Threshold_c5g) { |
| 14547 | fusionAlg_B.Switch_i5d = fusionAlg_P_g.Constant7_Value_k0; |
| 14548 | } else { |
| 14549 | fusionAlg_B.Switch_i5d = fusionAlg_P_g.Constant8_Value_bd; |
| 14550 | } |
| 14551 | |
| 14552 | /* End of Switch: '<S116>/Switch' */ |
| 14553 | |
| 14554 | /* DataTypeConversion: '<S116>/Data Type Conversion1' */ |
| 14555 | tmp = (real32_T)floor(fusionAlg_B.Selector17_f.DynProp); |
| 14556 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14557 | tmp = 0.0F; |
| 14558 | } else { |
| 14559 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14560 | } |
| 14561 | |
| 14562 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objMotionPattern = (uint8_T) |
| 14563 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14564 | tmp); |
| 14565 | |
| 14566 | /* End of DataTypeConversion: '<S116>/Data Type Conversion1' */ |
| 14567 | |
| 14568 | /* BusCreator: '<S116>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14569 | * Constant: '<S116>/Constant' |
| 14570 | * Constant: '<S116>/Constant1' |
| 14571 | */ |
| 14572 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.reserved.reserved1 = |
| 14573 | fusionAlg_P_g.Constant_Value_pwr; |
| 14574 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.reserved.reserved0 = |
| 14575 | fusionAlg_P_g.Constant1_Value_pxg; |
| 14576 | |
| 14577 | /* BusCreator: '<S116>/Bus Creator1' incorporates: |
| 14578 | * Constant: '<S116>/Constant10' |
| 14579 | * Constant: '<S116>/Constant2' |
| 14580 | * Constant: '<S116>/Constant3' |
| 14581 | * Constant: '<S116>/Constant4' |
| 14582 | * Constant: '<S116>/Constant5' |
| 14583 | * Constant: '<S116>/Constant6' |
| 14584 | * Constant: '<S116>/Constant9' |
| 14585 | */ |
| 14586 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objObstacleProb = |
| 14587 | fusionAlg_B.Selector17_f.RCS; |
| 14588 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objXPos_Stdev = |
| 14589 | fusionAlg_P_g.Constant2_Value_b; |
| 14590 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objYPos_Stdev = |
| 14591 | fusionAlg_P_g.Constant3_Value_nl; |
| 14592 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objXVelRel_Stdev = |
| 14593 | fusionAlg_P_g.Constant4_Value_gc; |
| 14594 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objXAccRel = |
| 14595 | fusionAlg_P_g.Constant5_Value_is; |
| 14596 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objExstProb = |
| 14597 | fusionAlg_P_g.Constant6_Value_ot; |
| 14598 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objYVelRel = |
| 14599 | fusionAlg_B.Selector17_f.VrelLat; |
| 14600 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objXVelRel = |
| 14601 | fusionAlg_B.Selector17_f.VrelLong; |
| 14602 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objXPos = |
| 14603 | fusionAlg_B.Selector17_f.DistLong; |
| 14604 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objYPos = |
| 14605 | fusionAlg_B.Selector17_f.DistLat; |
| 14606 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objID = |
| 14607 | fusionAlg_B.DataTypeConversion_jg5; |
| 14608 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objUpdateFlag = |
| 14609 | fusionAlg_B.Switch_i5d; |
| 14610 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objValidFlag = |
| 14611 | fusionAlg_B.Switch_i5d; |
| 14612 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objType = |
| 14613 | fusionAlg_P_g.Constant9_Value_mz; |
| 14614 | fusionAlg_B.BusCreator_a.radarObj.radar_25_obj.objMeasFlag = |
| 14615 | fusionAlg_P_g.Constant10_Value_ii; |
| 14616 | |
| 14617 | /* Selector: '<S97>/Selector18' incorporates: |
| 14618 | * Constant: '<S97>/Constant25' |
| 14619 | */ |
| 14620 | fusionAlg_B.Selector18_n = rtu_Radar308_Info_st-> |
| 14621 | rightFrontRadar_General[fusionAlg_P_g.Constant25_Value_b]; |
| 14622 | |
| 14623 | /* DataTypeConversion: '<S117>/Data Type Conversion' */ |
| 14624 | tmp = (real32_T)floor(fusionAlg_B.Selector18_n.ID); |
| 14625 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14626 | tmp = 0.0F; |
| 14627 | } else { |
| 14628 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14629 | } |
| 14630 | |
| 14631 | fusionAlg_B.DataTypeConversion_ik = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 14632 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14633 | |
| 14634 | /* End of DataTypeConversion: '<S117>/Data Type Conversion' */ |
| 14635 | |
| 14636 | /* Switch: '<S117>/Switch' incorporates: |
| 14637 | * Constant: '<S117>/Constant7' |
| 14638 | * Constant: '<S117>/Constant8' |
| 14639 | */ |
| 14640 | if (fusionAlg_B.DataTypeConversion_ik > fusionAlg_P_g.Switch_Threshold_mq) { |
| 14641 | fusionAlg_B.Switch_j2 = fusionAlg_P_g.Constant7_Value_lf; |
| 14642 | } else { |
| 14643 | fusionAlg_B.Switch_j2 = fusionAlg_P_g.Constant8_Value_ao; |
| 14644 | } |
| 14645 | |
| 14646 | /* End of Switch: '<S117>/Switch' */ |
| 14647 | |
| 14648 | /* DataTypeConversion: '<S117>/Data Type Conversion1' */ |
| 14649 | tmp = (real32_T)floor(fusionAlg_B.Selector18_n.DynProp); |
| 14650 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14651 | tmp = 0.0F; |
| 14652 | } else { |
| 14653 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14654 | } |
| 14655 | |
| 14656 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objMotionPattern = (uint8_T) |
| 14657 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14658 | tmp); |
| 14659 | |
| 14660 | /* End of DataTypeConversion: '<S117>/Data Type Conversion1' */ |
| 14661 | |
| 14662 | /* BusCreator: '<S117>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14663 | * Constant: '<S117>/Constant' |
| 14664 | * Constant: '<S117>/Constant1' |
| 14665 | */ |
| 14666 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.reserved.reserved1 = |
| 14667 | fusionAlg_P_g.Constant_Value_cs; |
| 14668 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.reserved.reserved0 = |
| 14669 | fusionAlg_P_g.Constant1_Value_dc; |
| 14670 | |
| 14671 | /* BusCreator: '<S117>/Bus Creator1' incorporates: |
| 14672 | * Constant: '<S117>/Constant10' |
| 14673 | * Constant: '<S117>/Constant2' |
| 14674 | * Constant: '<S117>/Constant3' |
| 14675 | * Constant: '<S117>/Constant4' |
| 14676 | * Constant: '<S117>/Constant5' |
| 14677 | * Constant: '<S117>/Constant6' |
| 14678 | * Constant: '<S117>/Constant9' |
| 14679 | */ |
| 14680 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objObstacleProb = |
| 14681 | fusionAlg_B.Selector18_n.RCS; |
| 14682 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objXPos_Stdev = |
| 14683 | fusionAlg_P_g.Constant2_Value_hv; |
| 14684 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objYPos_Stdev = |
| 14685 | fusionAlg_P_g.Constant3_Value_fw; |
| 14686 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objXVelRel_Stdev = |
| 14687 | fusionAlg_P_g.Constant4_Value_gq; |
| 14688 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objXAccRel = |
| 14689 | fusionAlg_P_g.Constant5_Value_dt; |
| 14690 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objExstProb = |
| 14691 | fusionAlg_P_g.Constant6_Value_fe; |
| 14692 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objYVelRel = |
| 14693 | fusionAlg_B.Selector18_n.VrelLat; |
| 14694 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objXVelRel = |
| 14695 | fusionAlg_B.Selector18_n.VrelLong; |
| 14696 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objXPos = |
| 14697 | fusionAlg_B.Selector18_n.DistLong; |
| 14698 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objYPos = |
| 14699 | fusionAlg_B.Selector18_n.DistLat; |
| 14700 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objID = |
| 14701 | fusionAlg_B.DataTypeConversion_ik; |
| 14702 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objUpdateFlag = |
| 14703 | fusionAlg_B.Switch_j2; |
| 14704 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objValidFlag = |
| 14705 | fusionAlg_B.Switch_j2; |
| 14706 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objType = |
| 14707 | fusionAlg_P_g.Constant9_Value_gso; |
| 14708 | fusionAlg_B.BusCreator_a.radarObj.radar_26_obj.objMeasFlag = |
| 14709 | fusionAlg_P_g.Constant10_Value_o0; |
| 14710 | |
| 14711 | /* Selector: '<S97>/Selector19' incorporates: |
| 14712 | * Constant: '<S97>/Constant26' |
| 14713 | */ |
| 14714 | fusionAlg_B.Selector19_l = rtu_Radar308_Info_st-> |
| 14715 | rightFrontRadar_General[fusionAlg_P_g.Constant26_Value_f]; |
| 14716 | |
| 14717 | /* DataTypeConversion: '<S118>/Data Type Conversion' */ |
| 14718 | tmp = (real32_T)floor(fusionAlg_B.Selector19_l.ID); |
| 14719 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14720 | tmp = 0.0F; |
| 14721 | } else { |
| 14722 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14723 | } |
| 14724 | |
| 14725 | fusionAlg_B.DataTypeConversion_onn = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 14726 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14727 | |
| 14728 | /* End of DataTypeConversion: '<S118>/Data Type Conversion' */ |
| 14729 | |
| 14730 | /* Switch: '<S118>/Switch' incorporates: |
| 14731 | * Constant: '<S118>/Constant7' |
| 14732 | * Constant: '<S118>/Constant8' |
| 14733 | */ |
| 14734 | if (fusionAlg_B.DataTypeConversion_onn > fusionAlg_P_g.Switch_Threshold_kg) { |
| 14735 | fusionAlg_B.Switch_cl = fusionAlg_P_g.Constant7_Value_ch; |
| 14736 | } else { |
| 14737 | fusionAlg_B.Switch_cl = fusionAlg_P_g.Constant8_Value_i3; |
| 14738 | } |
| 14739 | |
| 14740 | /* End of Switch: '<S118>/Switch' */ |
| 14741 | |
| 14742 | /* DataTypeConversion: '<S118>/Data Type Conversion1' */ |
| 14743 | tmp = (real32_T)floor(fusionAlg_B.Selector19_l.DynProp); |
| 14744 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14745 | tmp = 0.0F; |
| 14746 | } else { |
| 14747 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14748 | } |
| 14749 | |
| 14750 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objMotionPattern = (uint8_T) |
| 14751 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14752 | tmp); |
| 14753 | |
| 14754 | /* End of DataTypeConversion: '<S118>/Data Type Conversion1' */ |
| 14755 | |
| 14756 | /* BusCreator: '<S118>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14757 | * Constant: '<S118>/Constant' |
| 14758 | * Constant: '<S118>/Constant1' |
| 14759 | */ |
| 14760 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.reserved.reserved1 = |
| 14761 | fusionAlg_P_g.Constant_Value_n50; |
| 14762 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.reserved.reserved0 = |
| 14763 | fusionAlg_P_g.Constant1_Value_nv; |
| 14764 | |
| 14765 | /* BusCreator: '<S118>/Bus Creator1' incorporates: |
| 14766 | * Constant: '<S118>/Constant10' |
| 14767 | * Constant: '<S118>/Constant2' |
| 14768 | * Constant: '<S118>/Constant3' |
| 14769 | * Constant: '<S118>/Constant4' |
| 14770 | * Constant: '<S118>/Constant5' |
| 14771 | * Constant: '<S118>/Constant6' |
| 14772 | * Constant: '<S118>/Constant9' |
| 14773 | */ |
| 14774 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objObstacleProb = |
| 14775 | fusionAlg_B.Selector19_l.RCS; |
| 14776 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objXPos_Stdev = |
| 14777 | fusionAlg_P_g.Constant2_Value_p3; |
| 14778 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objYPos_Stdev = |
| 14779 | fusionAlg_P_g.Constant3_Value_g; |
| 14780 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objXVelRel_Stdev = |
| 14781 | fusionAlg_P_g.Constant4_Value_ff; |
| 14782 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objXAccRel = |
| 14783 | fusionAlg_P_g.Constant5_Value_mu; |
| 14784 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objExstProb = |
| 14785 | fusionAlg_P_g.Constant6_Value_pw; |
| 14786 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objYVelRel = |
| 14787 | fusionAlg_B.Selector19_l.VrelLat; |
| 14788 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objXVelRel = |
| 14789 | fusionAlg_B.Selector19_l.VrelLong; |
| 14790 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objXPos = |
| 14791 | fusionAlg_B.Selector19_l.DistLong; |
| 14792 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objYPos = |
| 14793 | fusionAlg_B.Selector19_l.DistLat; |
| 14794 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objID = |
| 14795 | fusionAlg_B.DataTypeConversion_onn; |
| 14796 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objUpdateFlag = |
| 14797 | fusionAlg_B.Switch_cl; |
| 14798 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objValidFlag = |
| 14799 | fusionAlg_B.Switch_cl; |
| 14800 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objType = |
| 14801 | fusionAlg_P_g.Constant9_Value_mk; |
| 14802 | fusionAlg_B.BusCreator_a.radarObj.radar_27_obj.objMeasFlag = |
| 14803 | fusionAlg_P_g.Constant10_Value_cc; |
| 14804 | |
| 14805 | /* Selector: '<S97>/Selector20' incorporates: |
| 14806 | * Constant: '<S97>/Constant27' |
| 14807 | */ |
| 14808 | fusionAlg_B.Selector20_k = rtu_Radar308_Info_st-> |
| 14809 | rightFrontRadar_General[fusionAlg_P_g.Constant27_Value_l]; |
| 14810 | |
| 14811 | /* DataTypeConversion: '<S119>/Data Type Conversion' */ |
| 14812 | tmp = (real32_T)floor(fusionAlg_B.Selector20_k.ID); |
| 14813 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14814 | tmp = 0.0F; |
| 14815 | } else { |
| 14816 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14817 | } |
| 14818 | |
| 14819 | fusionAlg_B.DataTypeConversion_lmq = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 14820 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14821 | |
| 14822 | /* End of DataTypeConversion: '<S119>/Data Type Conversion' */ |
| 14823 | |
| 14824 | /* Switch: '<S119>/Switch' incorporates: |
| 14825 | * Constant: '<S119>/Constant7' |
| 14826 | * Constant: '<S119>/Constant8' |
| 14827 | */ |
| 14828 | if (fusionAlg_B.DataTypeConversion_lmq > fusionAlg_P_g.Switch_Threshold_ey) { |
| 14829 | fusionAlg_B.Switch_mo = fusionAlg_P_g.Constant7_Value_ax; |
| 14830 | } else { |
| 14831 | fusionAlg_B.Switch_mo = fusionAlg_P_g.Constant8_Value_o4; |
| 14832 | } |
| 14833 | |
| 14834 | /* End of Switch: '<S119>/Switch' */ |
| 14835 | |
| 14836 | /* DataTypeConversion: '<S119>/Data Type Conversion1' */ |
| 14837 | tmp = (real32_T)floor(fusionAlg_B.Selector20_k.DynProp); |
| 14838 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14839 | tmp = 0.0F; |
| 14840 | } else { |
| 14841 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14842 | } |
| 14843 | |
| 14844 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objMotionPattern = (uint8_T) |
| 14845 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14846 | tmp); |
| 14847 | |
| 14848 | /* End of DataTypeConversion: '<S119>/Data Type Conversion1' */ |
| 14849 | |
| 14850 | /* BusCreator: '<S119>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14851 | * Constant: '<S119>/Constant' |
| 14852 | * Constant: '<S119>/Constant1' |
| 14853 | */ |
| 14854 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.reserved.reserved1 = |
| 14855 | fusionAlg_P_g.Constant_Value_bm; |
| 14856 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.reserved.reserved0 = |
| 14857 | fusionAlg_P_g.Constant1_Value_d4a; |
| 14858 | |
| 14859 | /* BusCreator: '<S119>/Bus Creator1' incorporates: |
| 14860 | * Constant: '<S119>/Constant10' |
| 14861 | * Constant: '<S119>/Constant2' |
| 14862 | * Constant: '<S119>/Constant3' |
| 14863 | * Constant: '<S119>/Constant4' |
| 14864 | * Constant: '<S119>/Constant5' |
| 14865 | * Constant: '<S119>/Constant6' |
| 14866 | * Constant: '<S119>/Constant9' |
| 14867 | */ |
| 14868 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objObstacleProb = |
| 14869 | fusionAlg_B.Selector20_k.RCS; |
| 14870 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objXPos_Stdev = |
| 14871 | fusionAlg_P_g.Constant2_Value_li; |
| 14872 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objYPos_Stdev = |
| 14873 | fusionAlg_P_g.Constant3_Value_jl; |
| 14874 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objXVelRel_Stdev = |
| 14875 | fusionAlg_P_g.Constant4_Value_mk; |
| 14876 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objXAccRel = |
| 14877 | fusionAlg_P_g.Constant5_Value_je; |
| 14878 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objExstProb = |
| 14879 | fusionAlg_P_g.Constant6_Value_ep; |
| 14880 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objYVelRel = |
| 14881 | fusionAlg_B.Selector20_k.VrelLat; |
| 14882 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objXVelRel = |
| 14883 | fusionAlg_B.Selector20_k.VrelLong; |
| 14884 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objXPos = |
| 14885 | fusionAlg_B.Selector20_k.DistLong; |
| 14886 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objYPos = |
| 14887 | fusionAlg_B.Selector20_k.DistLat; |
| 14888 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objID = |
| 14889 | fusionAlg_B.DataTypeConversion_lmq; |
| 14890 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objUpdateFlag = |
| 14891 | fusionAlg_B.Switch_mo; |
| 14892 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objValidFlag = |
| 14893 | fusionAlg_B.Switch_mo; |
| 14894 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objType = |
| 14895 | fusionAlg_P_g.Constant9_Value_ee; |
| 14896 | fusionAlg_B.BusCreator_a.radarObj.radar_28_obj.objMeasFlag = |
| 14897 | fusionAlg_P_g.Constant10_Value_j4; |
| 14898 | |
| 14899 | /* Selector: '<S97>/Selector21' incorporates: |
| 14900 | * Constant: '<S97>/Constant28' |
| 14901 | */ |
| 14902 | fusionAlg_B.Selector21_m = rtu_Radar308_Info_st-> |
| 14903 | rightFrontRadar_General[fusionAlg_P_g.Constant28_Value_c]; |
| 14904 | |
| 14905 | /* DataTypeConversion: '<S120>/Data Type Conversion' */ |
| 14906 | tmp = (real32_T)floor(fusionAlg_B.Selector21_m.ID); |
| 14907 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14908 | tmp = 0.0F; |
| 14909 | } else { |
| 14910 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 14911 | } |
| 14912 | |
| 14913 | fusionAlg_B.DataTypeConversion_ck = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 14914 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 14915 | |
| 14916 | /* End of DataTypeConversion: '<S120>/Data Type Conversion' */ |
| 14917 | |
| 14918 | /* Switch: '<S120>/Switch' incorporates: |
| 14919 | * Constant: '<S120>/Constant7' |
| 14920 | * Constant: '<S120>/Constant8' |
| 14921 | */ |
| 14922 | if (fusionAlg_B.DataTypeConversion_ck > fusionAlg_P_g.Switch_Threshold_al) { |
| 14923 | fusionAlg_B.Switch_cd = fusionAlg_P_g.Constant7_Value_a5; |
| 14924 | } else { |
| 14925 | fusionAlg_B.Switch_cd = fusionAlg_P_g.Constant8_Value_nc; |
| 14926 | } |
| 14927 | |
| 14928 | /* End of Switch: '<S120>/Switch' */ |
| 14929 | |
| 14930 | /* DataTypeConversion: '<S120>/Data Type Conversion1' */ |
| 14931 | tmp = (real32_T)floor(fusionAlg_B.Selector21_m.DynProp); |
| 14932 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 14933 | tmp = 0.0F; |
| 14934 | } else { |
| 14935 | tmp = (real32_T)fmod(tmp, 256.0); |
| 14936 | } |
| 14937 | |
| 14938 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objMotionPattern = (uint8_T) |
| 14939 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 14940 | tmp); |
| 14941 | |
| 14942 | /* End of DataTypeConversion: '<S120>/Data Type Conversion1' */ |
| 14943 | |
| 14944 | /* BusCreator: '<S120>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 14945 | * Constant: '<S120>/Constant' |
| 14946 | * Constant: '<S120>/Constant1' |
| 14947 | */ |
| 14948 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.reserved.reserved1 = |
| 14949 | fusionAlg_P_g.Constant_Value_lch; |
| 14950 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.reserved.reserved0 = |
| 14951 | fusionAlg_P_g.Constant1_Value_fvn; |
| 14952 | |
| 14953 | /* BusCreator: '<S120>/Bus Creator1' incorporates: |
| 14954 | * Constant: '<S120>/Constant10' |
| 14955 | * Constant: '<S120>/Constant2' |
| 14956 | * Constant: '<S120>/Constant3' |
| 14957 | * Constant: '<S120>/Constant4' |
| 14958 | * Constant: '<S120>/Constant5' |
| 14959 | * Constant: '<S120>/Constant6' |
| 14960 | * Constant: '<S120>/Constant9' |
| 14961 | */ |
| 14962 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objObstacleProb = |
| 14963 | fusionAlg_B.Selector21_m.RCS; |
| 14964 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objXPos_Stdev = |
| 14965 | fusionAlg_P_g.Constant2_Value_cj; |
| 14966 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objYPos_Stdev = |
| 14967 | fusionAlg_P_g.Constant3_Value_fr; |
| 14968 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objXVelRel_Stdev = |
| 14969 | fusionAlg_P_g.Constant4_Value_mr; |
| 14970 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objXAccRel = |
| 14971 | fusionAlg_P_g.Constant5_Value_iy; |
| 14972 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objExstProb = |
| 14973 | fusionAlg_P_g.Constant6_Value_bs; |
| 14974 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objYVelRel = |
| 14975 | fusionAlg_B.Selector21_m.VrelLat; |
| 14976 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objXVelRel = |
| 14977 | fusionAlg_B.Selector21_m.VrelLong; |
| 14978 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objXPos = |
| 14979 | fusionAlg_B.Selector21_m.DistLong; |
| 14980 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objYPos = |
| 14981 | fusionAlg_B.Selector21_m.DistLat; |
| 14982 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objID = |
| 14983 | fusionAlg_B.DataTypeConversion_ck; |
| 14984 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objUpdateFlag = |
| 14985 | fusionAlg_B.Switch_cd; |
| 14986 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objValidFlag = |
| 14987 | fusionAlg_B.Switch_cd; |
| 14988 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objType = |
| 14989 | fusionAlg_P_g.Constant9_Value_op; |
| 14990 | fusionAlg_B.BusCreator_a.radarObj.radar_29_obj.objMeasFlag = |
| 14991 | fusionAlg_P_g.Constant10_Value_hv; |
| 14992 | |
| 14993 | /* Selector: '<S97>/Selector22' incorporates: |
| 14994 | * Constant: '<S97>/Constant29' |
| 14995 | */ |
| 14996 | fusionAlg_B.Selector22_o = rtu_Radar308_Info_st-> |
| 14997 | rightFrontRadar_General[fusionAlg_P_g.Constant29_Value_m]; |
| 14998 | |
| 14999 | /* DataTypeConversion: '<S122>/Data Type Conversion' */ |
| 15000 | tmp = (real32_T)floor(fusionAlg_B.Selector22_o.ID); |
| 15001 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15002 | tmp = 0.0F; |
| 15003 | } else { |
| 15004 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15005 | } |
| 15006 | |
| 15007 | fusionAlg_B.DataTypeConversion_dd = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 15008 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15009 | |
| 15010 | /* End of DataTypeConversion: '<S122>/Data Type Conversion' */ |
| 15011 | |
| 15012 | /* Switch: '<S122>/Switch' incorporates: |
| 15013 | * Constant: '<S122>/Constant7' |
| 15014 | * Constant: '<S122>/Constant8' |
| 15015 | */ |
| 15016 | if (fusionAlg_B.DataTypeConversion_dd > fusionAlg_P_g.Switch_Threshold_em) { |
| 15017 | fusionAlg_B.Switch_md = fusionAlg_P_g.Constant7_Value_m2; |
| 15018 | } else { |
| 15019 | fusionAlg_B.Switch_md = fusionAlg_P_g.Constant8_Value_fo; |
| 15020 | } |
| 15021 | |
| 15022 | /* End of Switch: '<S122>/Switch' */ |
| 15023 | |
| 15024 | /* DataTypeConversion: '<S122>/Data Type Conversion1' */ |
| 15025 | tmp = (real32_T)floor(fusionAlg_B.Selector22_o.DynProp); |
| 15026 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15027 | tmp = 0.0F; |
| 15028 | } else { |
| 15029 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15030 | } |
| 15031 | |
| 15032 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objMotionPattern = (uint8_T) |
| 15033 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15034 | tmp); |
| 15035 | |
| 15036 | /* End of DataTypeConversion: '<S122>/Data Type Conversion1' */ |
| 15037 | |
| 15038 | /* BusCreator: '<S122>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15039 | * Constant: '<S122>/Constant' |
| 15040 | * Constant: '<S122>/Constant1' |
| 15041 | */ |
| 15042 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.reserved.reserved1 = |
| 15043 | fusionAlg_P_g.Constant_Value_mk; |
| 15044 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.reserved.reserved0 = |
| 15045 | fusionAlg_P_g.Constant1_Value_nvp; |
| 15046 | |
| 15047 | /* BusCreator: '<S122>/Bus Creator1' incorporates: |
| 15048 | * Constant: '<S122>/Constant10' |
| 15049 | * Constant: '<S122>/Constant2' |
| 15050 | * Constant: '<S122>/Constant3' |
| 15051 | * Constant: '<S122>/Constant4' |
| 15052 | * Constant: '<S122>/Constant5' |
| 15053 | * Constant: '<S122>/Constant6' |
| 15054 | * Constant: '<S122>/Constant9' |
| 15055 | */ |
| 15056 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objObstacleProb = |
| 15057 | fusionAlg_B.Selector22_o.RCS; |
| 15058 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objXPos_Stdev = |
| 15059 | fusionAlg_P_g.Constant2_Value_dn; |
| 15060 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objYPos_Stdev = |
| 15061 | fusionAlg_P_g.Constant3_Value_gj; |
| 15062 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objXVelRel_Stdev = |
| 15063 | fusionAlg_P_g.Constant4_Value_gyd; |
| 15064 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objXAccRel = |
| 15065 | fusionAlg_P_g.Constant5_Value_k0; |
| 15066 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objExstProb = |
| 15067 | fusionAlg_P_g.Constant6_Value_no; |
| 15068 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objYVelRel = |
| 15069 | fusionAlg_B.Selector22_o.VrelLat; |
| 15070 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objXVelRel = |
| 15071 | fusionAlg_B.Selector22_o.VrelLong; |
| 15072 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objXPos = |
| 15073 | fusionAlg_B.Selector22_o.DistLong; |
| 15074 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objYPos = |
| 15075 | fusionAlg_B.Selector22_o.DistLat; |
| 15076 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objID = |
| 15077 | fusionAlg_B.DataTypeConversion_dd; |
| 15078 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objUpdateFlag = |
| 15079 | fusionAlg_B.Switch_md; |
| 15080 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objValidFlag = |
| 15081 | fusionAlg_B.Switch_md; |
| 15082 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objType = |
| 15083 | fusionAlg_P_g.Constant9_Value_eq; |
| 15084 | fusionAlg_B.BusCreator_a.radarObj.radar_30_obj.objMeasFlag = |
| 15085 | fusionAlg_P_g.Constant10_Value_mf; |
| 15086 | |
| 15087 | /* Selector: '<S97>/Selector23' incorporates: |
| 15088 | * Constant: '<S97>/Constant30' |
| 15089 | */ |
| 15090 | fusionAlg_B.Selector23_d = rtu_Radar308_Info_st-> |
| 15091 | rightFrontRadar_General[fusionAlg_P_g.Constant30_Value_e]; |
| 15092 | |
| 15093 | /* DataTypeConversion: '<S123>/Data Type Conversion' */ |
| 15094 | tmp = (real32_T)floor(fusionAlg_B.Selector23_d.ID); |
| 15095 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15096 | tmp = 0.0F; |
| 15097 | } else { |
| 15098 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15099 | } |
| 15100 | |
| 15101 | fusionAlg_B.DataTypeConversion_j5b = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 15102 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15103 | |
| 15104 | /* End of DataTypeConversion: '<S123>/Data Type Conversion' */ |
| 15105 | |
| 15106 | /* Switch: '<S123>/Switch' incorporates: |
| 15107 | * Constant: '<S123>/Constant7' |
| 15108 | * Constant: '<S123>/Constant8' |
| 15109 | */ |
| 15110 | if (fusionAlg_B.DataTypeConversion_j5b > fusionAlg_P_g.Switch_Threshold_f1) { |
| 15111 | fusionAlg_B.Switch_de = fusionAlg_P_g.Constant7_Value_lb; |
| 15112 | } else { |
| 15113 | fusionAlg_B.Switch_de = fusionAlg_P_g.Constant8_Value_iw; |
| 15114 | } |
| 15115 | |
| 15116 | /* End of Switch: '<S123>/Switch' */ |
| 15117 | |
| 15118 | /* DataTypeConversion: '<S123>/Data Type Conversion1' */ |
| 15119 | tmp = (real32_T)floor(fusionAlg_B.Selector23_d.DynProp); |
| 15120 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15121 | tmp = 0.0F; |
| 15122 | } else { |
| 15123 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15124 | } |
| 15125 | |
| 15126 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objMotionPattern = (uint8_T) |
| 15127 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15128 | tmp); |
| 15129 | |
| 15130 | /* End of DataTypeConversion: '<S123>/Data Type Conversion1' */ |
| 15131 | |
| 15132 | /* BusCreator: '<S123>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15133 | * Constant: '<S123>/Constant' |
| 15134 | * Constant: '<S123>/Constant1' |
| 15135 | */ |
| 15136 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.reserved.reserved1 = |
| 15137 | fusionAlg_P_g.Constant_Value_d2b; |
| 15138 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.reserved.reserved0 = |
| 15139 | fusionAlg_P_g.Constant1_Value_mj; |
| 15140 | |
| 15141 | /* BusCreator: '<S123>/Bus Creator1' incorporates: |
| 15142 | * Constant: '<S123>/Constant10' |
| 15143 | * Constant: '<S123>/Constant2' |
| 15144 | * Constant: '<S123>/Constant3' |
| 15145 | * Constant: '<S123>/Constant4' |
| 15146 | * Constant: '<S123>/Constant5' |
| 15147 | * Constant: '<S123>/Constant6' |
| 15148 | * Constant: '<S123>/Constant9' |
| 15149 | */ |
| 15150 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objObstacleProb = |
| 15151 | fusionAlg_B.Selector23_d.RCS; |
| 15152 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objXPos_Stdev = |
| 15153 | fusionAlg_P_g.Constant2_Value_ci; |
| 15154 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objYPos_Stdev = |
| 15155 | fusionAlg_P_g.Constant3_Value_h2; |
| 15156 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objXVelRel_Stdev = |
| 15157 | fusionAlg_P_g.Constant4_Value_kr; |
| 15158 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objXAccRel = |
| 15159 | fusionAlg_P_g.Constant5_Value_i5; |
| 15160 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objExstProb = |
| 15161 | fusionAlg_P_g.Constant6_Value_c4; |
| 15162 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objYVelRel = |
| 15163 | fusionAlg_B.Selector23_d.VrelLat; |
| 15164 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objXVelRel = |
| 15165 | fusionAlg_B.Selector23_d.VrelLong; |
| 15166 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objXPos = |
| 15167 | fusionAlg_B.Selector23_d.DistLong; |
| 15168 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objYPos = |
| 15169 | fusionAlg_B.Selector23_d.DistLat; |
| 15170 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objID = |
| 15171 | fusionAlg_B.DataTypeConversion_j5b; |
| 15172 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objUpdateFlag = |
| 15173 | fusionAlg_B.Switch_de; |
| 15174 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objValidFlag = |
| 15175 | fusionAlg_B.Switch_de; |
| 15176 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objType = |
| 15177 | fusionAlg_P_g.Constant9_Value_dc; |
| 15178 | fusionAlg_B.BusCreator_a.radarObj.radar_31_obj.objMeasFlag = |
| 15179 | fusionAlg_P_g.Constant10_Value_kt; |
| 15180 | |
| 15181 | /* Selector: '<S97>/Selector31' incorporates: |
| 15182 | * Constant: '<S97>/Constant31' |
| 15183 | */ |
| 15184 | fusionAlg_B.Selector31_lp = rtu_Radar308_Info_st-> |
| 15185 | rightFrontRadar_General[fusionAlg_P_g.Constant31_Value_c]; |
| 15186 | |
| 15187 | /* DataTypeConversion: '<S124>/Data Type Conversion' */ |
| 15188 | tmp = (real32_T)floor(fusionAlg_B.Selector31_lp.ID); |
| 15189 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15190 | tmp = 0.0F; |
| 15191 | } else { |
| 15192 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15193 | } |
| 15194 | |
| 15195 | fusionAlg_B.DataTypeConversion_dk = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 15196 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15197 | |
| 15198 | /* End of DataTypeConversion: '<S124>/Data Type Conversion' */ |
| 15199 | |
| 15200 | /* Switch: '<S124>/Switch' incorporates: |
| 15201 | * Constant: '<S124>/Constant7' |
| 15202 | * Constant: '<S124>/Constant8' |
| 15203 | */ |
| 15204 | if (fusionAlg_B.DataTypeConversion_dk > fusionAlg_P_g.Switch_Threshold_go) { |
| 15205 | fusionAlg_B.Switch_m0 = fusionAlg_P_g.Constant7_Value_op; |
| 15206 | } else { |
| 15207 | fusionAlg_B.Switch_m0 = fusionAlg_P_g.Constant8_Value_ah; |
| 15208 | } |
| 15209 | |
| 15210 | /* End of Switch: '<S124>/Switch' */ |
| 15211 | |
| 15212 | /* DataTypeConversion: '<S124>/Data Type Conversion1' */ |
| 15213 | tmp = (real32_T)floor(fusionAlg_B.Selector31_lp.DynProp); |
| 15214 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15215 | tmp = 0.0F; |
| 15216 | } else { |
| 15217 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15218 | } |
| 15219 | |
| 15220 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objMotionPattern = (uint8_T) |
| 15221 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15222 | tmp); |
| 15223 | |
| 15224 | /* End of DataTypeConversion: '<S124>/Data Type Conversion1' */ |
| 15225 | |
| 15226 | /* BusCreator: '<S124>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15227 | * Constant: '<S124>/Constant' |
| 15228 | * Constant: '<S124>/Constant1' |
| 15229 | */ |
| 15230 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.reserved.reserved1 = |
| 15231 | fusionAlg_P_g.Constant_Value_ouz; |
| 15232 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.reserved.reserved0 = |
| 15233 | fusionAlg_P_g.Constant1_Value_d3p; |
| 15234 | |
| 15235 | /* BusCreator: '<S124>/Bus Creator1' incorporates: |
| 15236 | * Constant: '<S124>/Constant10' |
| 15237 | * Constant: '<S124>/Constant2' |
| 15238 | * Constant: '<S124>/Constant3' |
| 15239 | * Constant: '<S124>/Constant4' |
| 15240 | * Constant: '<S124>/Constant5' |
| 15241 | * Constant: '<S124>/Constant6' |
| 15242 | * Constant: '<S124>/Constant9' |
| 15243 | */ |
| 15244 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objObstacleProb = |
| 15245 | fusionAlg_B.Selector31_lp.RCS; |
| 15246 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objXPos_Stdev = |
| 15247 | fusionAlg_P_g.Constant2_Value_mm; |
| 15248 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objYPos_Stdev = |
| 15249 | fusionAlg_P_g.Constant3_Value_fv; |
| 15250 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objXVelRel_Stdev = |
| 15251 | fusionAlg_P_g.Constant4_Value_g5; |
| 15252 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objXAccRel = |
| 15253 | fusionAlg_P_g.Constant5_Value_ek; |
| 15254 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objExstProb = |
| 15255 | fusionAlg_P_g.Constant6_Value_i01; |
| 15256 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objYVelRel = |
| 15257 | fusionAlg_B.Selector31_lp.VrelLat; |
| 15258 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objXVelRel = |
| 15259 | fusionAlg_B.Selector31_lp.VrelLong; |
| 15260 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objXPos = |
| 15261 | fusionAlg_B.Selector31_lp.DistLong; |
| 15262 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objYPos = |
| 15263 | fusionAlg_B.Selector31_lp.DistLat; |
| 15264 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objID = |
| 15265 | fusionAlg_B.DataTypeConversion_dk; |
| 15266 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objUpdateFlag = |
| 15267 | fusionAlg_B.Switch_m0; |
| 15268 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objValidFlag = |
| 15269 | fusionAlg_B.Switch_m0; |
| 15270 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objType = |
| 15271 | fusionAlg_P_g.Constant9_Value_od; |
| 15272 | fusionAlg_B.BusCreator_a.radarObj.radar_32_obj.objMeasFlag = |
| 15273 | fusionAlg_P_g.Constant10_Value_ok; |
| 15274 | |
| 15275 | /* Selector: '<S97>/Selector32' incorporates: |
| 15276 | * Constant: '<S97>/Constant32' |
| 15277 | */ |
| 15278 | fusionAlg_B.Selector32_p = rtu_Radar308_Info_st-> |
| 15279 | rightFrontRadar_General[fusionAlg_P_g.Constant32_Value_p]; |
| 15280 | |
| 15281 | /* DataTypeConversion: '<S125>/Data Type Conversion' */ |
| 15282 | tmp = (real32_T)floor(fusionAlg_B.Selector32_p.ID); |
| 15283 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15284 | tmp = 0.0F; |
| 15285 | } else { |
| 15286 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15287 | } |
| 15288 | |
| 15289 | fusionAlg_B.DataTypeConversion_ke = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 15290 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15291 | |
| 15292 | /* End of DataTypeConversion: '<S125>/Data Type Conversion' */ |
| 15293 | |
| 15294 | /* Switch: '<S125>/Switch' incorporates: |
| 15295 | * Constant: '<S125>/Constant7' |
| 15296 | * Constant: '<S125>/Constant8' |
| 15297 | */ |
| 15298 | if (fusionAlg_B.DataTypeConversion_ke > fusionAlg_P_g.Switch_Threshold_cv) { |
| 15299 | fusionAlg_B.Switch_il = fusionAlg_P_g.Constant7_Value_bt; |
| 15300 | } else { |
| 15301 | fusionAlg_B.Switch_il = fusionAlg_P_g.Constant8_Value_i0; |
| 15302 | } |
| 15303 | |
| 15304 | /* End of Switch: '<S125>/Switch' */ |
| 15305 | |
| 15306 | /* DataTypeConversion: '<S125>/Data Type Conversion1' */ |
| 15307 | tmp = (real32_T)floor(fusionAlg_B.Selector32_p.DynProp); |
| 15308 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15309 | tmp = 0.0F; |
| 15310 | } else { |
| 15311 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15312 | } |
| 15313 | |
| 15314 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objMotionPattern = (uint8_T) |
| 15315 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15316 | tmp); |
| 15317 | |
| 15318 | /* End of DataTypeConversion: '<S125>/Data Type Conversion1' */ |
| 15319 | |
| 15320 | /* BusCreator: '<S125>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15321 | * Constant: '<S125>/Constant' |
| 15322 | * Constant: '<S125>/Constant1' |
| 15323 | */ |
| 15324 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.reserved.reserved1 = |
| 15325 | fusionAlg_P_g.Constant_Value_hg; |
| 15326 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.reserved.reserved0 = |
| 15327 | fusionAlg_P_g.Constant1_Value_ag; |
| 15328 | |
| 15329 | /* BusCreator: '<S125>/Bus Creator1' incorporates: |
| 15330 | * Constant: '<S125>/Constant10' |
| 15331 | * Constant: '<S125>/Constant2' |
| 15332 | * Constant: '<S125>/Constant3' |
| 15333 | * Constant: '<S125>/Constant4' |
| 15334 | * Constant: '<S125>/Constant5' |
| 15335 | * Constant: '<S125>/Constant6' |
| 15336 | * Constant: '<S125>/Constant9' |
| 15337 | */ |
| 15338 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objObstacleProb = |
| 15339 | fusionAlg_B.Selector32_p.RCS; |
| 15340 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objXPos_Stdev = |
| 15341 | fusionAlg_P_g.Constant2_Value_bw; |
| 15342 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objYPos_Stdev = |
| 15343 | fusionAlg_P_g.Constant3_Value_mm; |
| 15344 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objXVelRel_Stdev = |
| 15345 | fusionAlg_P_g.Constant4_Value_dw; |
| 15346 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objXAccRel = |
| 15347 | fusionAlg_P_g.Constant5_Value_aan; |
| 15348 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objExstProb = |
| 15349 | fusionAlg_P_g.Constant6_Value_cs; |
| 15350 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objYVelRel = |
| 15351 | fusionAlg_B.Selector32_p.VrelLat; |
| 15352 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objXVelRel = |
| 15353 | fusionAlg_B.Selector32_p.VrelLong; |
| 15354 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objXPos = |
| 15355 | fusionAlg_B.Selector32_p.DistLong; |
| 15356 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objYPos = |
| 15357 | fusionAlg_B.Selector32_p.DistLat; |
| 15358 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objID = |
| 15359 | fusionAlg_B.DataTypeConversion_ke; |
| 15360 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objUpdateFlag = |
| 15361 | fusionAlg_B.Switch_il; |
| 15362 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objValidFlag = |
| 15363 | fusionAlg_B.Switch_il; |
| 15364 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objType = |
| 15365 | fusionAlg_P_g.Constant9_Value_nf; |
| 15366 | fusionAlg_B.BusCreator_a.radarObj.radar_33_obj.objMeasFlag = |
| 15367 | fusionAlg_P_g.Constant10_Value_eb; |
| 15368 | |
| 15369 | /* Selector: '<S97>/Selector33' incorporates: |
| 15370 | * Constant: '<S97>/Constant33' |
| 15371 | */ |
| 15372 | fusionAlg_B.Selector33_m = rtu_Radar308_Info_st-> |
| 15373 | rightFrontRadar_General[fusionAlg_P_g.Constant33_Value_k]; |
| 15374 | |
| 15375 | /* DataTypeConversion: '<S126>/Data Type Conversion' */ |
| 15376 | tmp = (real32_T)floor(fusionAlg_B.Selector33_m.ID); |
| 15377 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15378 | tmp = 0.0F; |
| 15379 | } else { |
| 15380 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15381 | } |
| 15382 | |
| 15383 | fusionAlg_B.DataTypeConversion_bu = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 15384 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15385 | |
| 15386 | /* End of DataTypeConversion: '<S126>/Data Type Conversion' */ |
| 15387 | |
| 15388 | /* Switch: '<S126>/Switch' incorporates: |
| 15389 | * Constant: '<S126>/Constant7' |
| 15390 | * Constant: '<S126>/Constant8' |
| 15391 | */ |
| 15392 | if (fusionAlg_B.DataTypeConversion_bu > fusionAlg_P_g.Switch_Threshold_hn) { |
| 15393 | fusionAlg_B.Switch_av = fusionAlg_P_g.Constant7_Value_as; |
| 15394 | } else { |
| 15395 | fusionAlg_B.Switch_av = fusionAlg_P_g.Constant8_Value_fx; |
| 15396 | } |
| 15397 | |
| 15398 | /* End of Switch: '<S126>/Switch' */ |
| 15399 | |
| 15400 | /* DataTypeConversion: '<S126>/Data Type Conversion1' */ |
| 15401 | tmp = (real32_T)floor(fusionAlg_B.Selector33_m.DynProp); |
| 15402 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15403 | tmp = 0.0F; |
| 15404 | } else { |
| 15405 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15406 | } |
| 15407 | |
| 15408 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objMotionPattern = (uint8_T) |
| 15409 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15410 | tmp); |
| 15411 | |
| 15412 | /* End of DataTypeConversion: '<S126>/Data Type Conversion1' */ |
| 15413 | |
| 15414 | /* BusCreator: '<S126>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15415 | * Constant: '<S126>/Constant' |
| 15416 | * Constant: '<S126>/Constant1' |
| 15417 | */ |
| 15418 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.reserved.reserved1 = |
| 15419 | fusionAlg_P_g.Constant_Value_ef; |
| 15420 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.reserved.reserved0 = |
| 15421 | fusionAlg_P_g.Constant1_Value_as; |
| 15422 | |
| 15423 | /* BusCreator: '<S126>/Bus Creator1' incorporates: |
| 15424 | * Constant: '<S126>/Constant10' |
| 15425 | * Constant: '<S126>/Constant2' |
| 15426 | * Constant: '<S126>/Constant3' |
| 15427 | * Constant: '<S126>/Constant4' |
| 15428 | * Constant: '<S126>/Constant5' |
| 15429 | * Constant: '<S126>/Constant6' |
| 15430 | * Constant: '<S126>/Constant9' |
| 15431 | */ |
| 15432 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objObstacleProb = |
| 15433 | fusionAlg_B.Selector33_m.RCS; |
| 15434 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objXPos_Stdev = |
| 15435 | fusionAlg_P_g.Constant2_Value_gq; |
| 15436 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objYPos_Stdev = |
| 15437 | fusionAlg_P_g.Constant3_Value_ot; |
| 15438 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objXVelRel_Stdev = |
| 15439 | fusionAlg_P_g.Constant4_Value_i5; |
| 15440 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objXAccRel = |
| 15441 | fusionAlg_P_g.Constant5_Value_ok; |
| 15442 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objExstProb = |
| 15443 | fusionAlg_P_g.Constant6_Value_cz; |
| 15444 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objYVelRel = |
| 15445 | fusionAlg_B.Selector33_m.VrelLat; |
| 15446 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objXVelRel = |
| 15447 | fusionAlg_B.Selector33_m.VrelLong; |
| 15448 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objXPos = |
| 15449 | fusionAlg_B.Selector33_m.DistLong; |
| 15450 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objYPos = |
| 15451 | fusionAlg_B.Selector33_m.DistLat; |
| 15452 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objID = |
| 15453 | fusionAlg_B.DataTypeConversion_bu; |
| 15454 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objUpdateFlag = |
| 15455 | fusionAlg_B.Switch_av; |
| 15456 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objValidFlag = |
| 15457 | fusionAlg_B.Switch_av; |
| 15458 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objType = |
| 15459 | fusionAlg_P_g.Constant9_Value_dc3; |
| 15460 | fusionAlg_B.BusCreator_a.radarObj.radar_34_obj.objMeasFlag = |
| 15461 | fusionAlg_P_g.Constant10_Value_ne; |
| 15462 | |
| 15463 | /* Selector: '<S97>/Selector34' incorporates: |
| 15464 | * Constant: '<S97>/Constant34' |
| 15465 | */ |
| 15466 | fusionAlg_B.Selector34_l = rtu_Radar308_Info_st-> |
| 15467 | rightFrontRadar_General[fusionAlg_P_g.Constant34_Value_b]; |
| 15468 | |
| 15469 | /* DataTypeConversion: '<S127>/Data Type Conversion' */ |
| 15470 | tmp = (real32_T)floor(fusionAlg_B.Selector34_l.ID); |
| 15471 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15472 | tmp = 0.0F; |
| 15473 | } else { |
| 15474 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15475 | } |
| 15476 | |
| 15477 | fusionAlg_B.DataTypeConversion_mk = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 15478 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15479 | |
| 15480 | /* End of DataTypeConversion: '<S127>/Data Type Conversion' */ |
| 15481 | |
| 15482 | /* Switch: '<S127>/Switch' incorporates: |
| 15483 | * Constant: '<S127>/Constant7' |
| 15484 | * Constant: '<S127>/Constant8' |
| 15485 | */ |
| 15486 | if (fusionAlg_B.DataTypeConversion_mk > fusionAlg_P_g.Switch_Threshold_oy) { |
| 15487 | fusionAlg_B.Switch_p2 = fusionAlg_P_g.Constant7_Value_a2; |
| 15488 | } else { |
| 15489 | fusionAlg_B.Switch_p2 = fusionAlg_P_g.Constant8_Value_knu; |
| 15490 | } |
| 15491 | |
| 15492 | /* End of Switch: '<S127>/Switch' */ |
| 15493 | |
| 15494 | /* DataTypeConversion: '<S127>/Data Type Conversion1' */ |
| 15495 | tmp = (real32_T)floor(fusionAlg_B.Selector34_l.DynProp); |
| 15496 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15497 | tmp = 0.0F; |
| 15498 | } else { |
| 15499 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15500 | } |
| 15501 | |
| 15502 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objMotionPattern = (uint8_T) |
| 15503 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15504 | tmp); |
| 15505 | |
| 15506 | /* End of DataTypeConversion: '<S127>/Data Type Conversion1' */ |
| 15507 | |
| 15508 | /* BusCreator: '<S127>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15509 | * Constant: '<S127>/Constant' |
| 15510 | * Constant: '<S127>/Constant1' |
| 15511 | */ |
| 15512 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.reserved.reserved1 = |
| 15513 | fusionAlg_P_g.Constant_Value_d3v; |
| 15514 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.reserved.reserved0 = |
| 15515 | fusionAlg_P_g.Constant1_Value_hg; |
| 15516 | |
| 15517 | /* BusCreator: '<S127>/Bus Creator1' incorporates: |
| 15518 | * Constant: '<S127>/Constant10' |
| 15519 | * Constant: '<S127>/Constant2' |
| 15520 | * Constant: '<S127>/Constant3' |
| 15521 | * Constant: '<S127>/Constant4' |
| 15522 | * Constant: '<S127>/Constant5' |
| 15523 | * Constant: '<S127>/Constant6' |
| 15524 | * Constant: '<S127>/Constant9' |
| 15525 | */ |
| 15526 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objObstacleProb = |
| 15527 | fusionAlg_B.Selector34_l.RCS; |
| 15528 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objXPos_Stdev = |
| 15529 | fusionAlg_P_g.Constant2_Value_gr; |
| 15530 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objYPos_Stdev = |
| 15531 | fusionAlg_P_g.Constant3_Value_en; |
| 15532 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objXVelRel_Stdev = |
| 15533 | fusionAlg_P_g.Constant4_Value_ao; |
| 15534 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objXAccRel = |
| 15535 | fusionAlg_P_g.Constant5_Value_gy; |
| 15536 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objExstProb = |
| 15537 | fusionAlg_P_g.Constant6_Value_mx; |
| 15538 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objYVelRel = |
| 15539 | fusionAlg_B.Selector34_l.VrelLat; |
| 15540 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objXVelRel = |
| 15541 | fusionAlg_B.Selector34_l.VrelLong; |
| 15542 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objXPos = |
| 15543 | fusionAlg_B.Selector34_l.DistLong; |
| 15544 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objYPos = |
| 15545 | fusionAlg_B.Selector34_l.DistLat; |
| 15546 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objID = |
| 15547 | fusionAlg_B.DataTypeConversion_mk; |
| 15548 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objUpdateFlag = |
| 15549 | fusionAlg_B.Switch_p2; |
| 15550 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objValidFlag = |
| 15551 | fusionAlg_B.Switch_p2; |
| 15552 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objType = |
| 15553 | fusionAlg_P_g.Constant9_Value_i5; |
| 15554 | fusionAlg_B.BusCreator_a.radarObj.radar_35_obj.objMeasFlag = |
| 15555 | fusionAlg_P_g.Constant10_Value_kp; |
| 15556 | |
| 15557 | /* Selector: '<S97>/Selector35' incorporates: |
| 15558 | * Constant: '<S97>/Constant35' |
| 15559 | */ |
| 15560 | fusionAlg_B.Selector35_e = rtu_Radar308_Info_st-> |
| 15561 | rightFrontRadar_General[fusionAlg_P_g.Constant35_Value_p]; |
| 15562 | |
| 15563 | /* DataTypeConversion: '<S128>/Data Type Conversion' */ |
| 15564 | tmp = (real32_T)floor(fusionAlg_B.Selector35_e.ID); |
| 15565 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15566 | tmp = 0.0F; |
| 15567 | } else { |
| 15568 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15569 | } |
| 15570 | |
| 15571 | fusionAlg_B.DataTypeConversion_k0 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 15572 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15573 | |
| 15574 | /* End of DataTypeConversion: '<S128>/Data Type Conversion' */ |
| 15575 | |
| 15576 | /* Switch: '<S128>/Switch' incorporates: |
| 15577 | * Constant: '<S128>/Constant7' |
| 15578 | * Constant: '<S128>/Constant8' |
| 15579 | */ |
| 15580 | if (fusionAlg_B.DataTypeConversion_k0 > fusionAlg_P_g.Switch_Threshold_kdl) { |
| 15581 | fusionAlg_B.Switch_n1e = fusionAlg_P_g.Constant7_Value_oh; |
| 15582 | } else { |
| 15583 | fusionAlg_B.Switch_n1e = fusionAlg_P_g.Constant8_Value_knd; |
| 15584 | } |
| 15585 | |
| 15586 | /* End of Switch: '<S128>/Switch' */ |
| 15587 | |
| 15588 | /* DataTypeConversion: '<S128>/Data Type Conversion1' */ |
| 15589 | tmp = (real32_T)floor(fusionAlg_B.Selector35_e.DynProp); |
| 15590 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15591 | tmp = 0.0F; |
| 15592 | } else { |
| 15593 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15594 | } |
| 15595 | |
| 15596 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objMotionPattern = (uint8_T) |
| 15597 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15598 | tmp); |
| 15599 | |
| 15600 | /* End of DataTypeConversion: '<S128>/Data Type Conversion1' */ |
| 15601 | |
| 15602 | /* BusCreator: '<S128>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15603 | * Constant: '<S128>/Constant' |
| 15604 | * Constant: '<S128>/Constant1' |
| 15605 | */ |
| 15606 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.reserved.reserved1 = |
| 15607 | fusionAlg_P_g.Constant_Value_jd; |
| 15608 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.reserved.reserved0 = |
| 15609 | fusionAlg_P_g.Constant1_Value_fe; |
| 15610 | |
| 15611 | /* BusCreator: '<S128>/Bus Creator1' incorporates: |
| 15612 | * Constant: '<S128>/Constant10' |
| 15613 | * Constant: '<S128>/Constant2' |
| 15614 | * Constant: '<S128>/Constant3' |
| 15615 | * Constant: '<S128>/Constant4' |
| 15616 | * Constant: '<S128>/Constant5' |
| 15617 | * Constant: '<S128>/Constant6' |
| 15618 | * Constant: '<S128>/Constant9' |
| 15619 | */ |
| 15620 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objObstacleProb = |
| 15621 | fusionAlg_B.Selector35_e.RCS; |
| 15622 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objXPos_Stdev = |
| 15623 | fusionAlg_P_g.Constant2_Value_ms; |
| 15624 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objYPos_Stdev = |
| 15625 | fusionAlg_P_g.Constant3_Value_pg; |
| 15626 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objXVelRel_Stdev = |
| 15627 | fusionAlg_P_g.Constant4_Value_pl; |
| 15628 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objXAccRel = |
| 15629 | fusionAlg_P_g.Constant5_Value_fe; |
| 15630 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objExstProb = |
| 15631 | fusionAlg_P_g.Constant6_Value_iu; |
| 15632 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objYVelRel = |
| 15633 | fusionAlg_B.Selector35_e.VrelLat; |
| 15634 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objXVelRel = |
| 15635 | fusionAlg_B.Selector35_e.VrelLong; |
| 15636 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objXPos = |
| 15637 | fusionAlg_B.Selector35_e.DistLong; |
| 15638 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objYPos = |
| 15639 | fusionAlg_B.Selector35_e.DistLat; |
| 15640 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objID = |
| 15641 | fusionAlg_B.DataTypeConversion_k0; |
| 15642 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objUpdateFlag = |
| 15643 | fusionAlg_B.Switch_n1e; |
| 15644 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objValidFlag = |
| 15645 | fusionAlg_B.Switch_n1e; |
| 15646 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objType = |
| 15647 | fusionAlg_P_g.Constant9_Value_ld; |
| 15648 | fusionAlg_B.BusCreator_a.radarObj.radar_36_obj.objMeasFlag = |
| 15649 | fusionAlg_P_g.Constant10_Value_bp; |
| 15650 | |
| 15651 | /* Selector: '<S97>/Selector36' incorporates: |
| 15652 | * Constant: '<S97>/Constant36' |
| 15653 | */ |
| 15654 | fusionAlg_B.Selector36_a = rtu_Radar308_Info_st-> |
| 15655 | rightFrontRadar_General[fusionAlg_P_g.Constant36_Value_f]; |
| 15656 | |
| 15657 | /* DataTypeConversion: '<S129>/Data Type Conversion' */ |
| 15658 | tmp = (real32_T)floor(fusionAlg_B.Selector36_a.ID); |
| 15659 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15660 | tmp = 0.0F; |
| 15661 | } else { |
| 15662 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15663 | } |
| 15664 | |
| 15665 | fusionAlg_B.DataTypeConversion_hfo = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 15666 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15667 | |
| 15668 | /* End of DataTypeConversion: '<S129>/Data Type Conversion' */ |
| 15669 | |
| 15670 | /* Switch: '<S129>/Switch' incorporates: |
| 15671 | * Constant: '<S129>/Constant7' |
| 15672 | * Constant: '<S129>/Constant8' |
| 15673 | */ |
| 15674 | if (fusionAlg_B.DataTypeConversion_hfo > fusionAlg_P_g.Switch_Threshold_af) { |
| 15675 | fusionAlg_B.Switch_fj = fusionAlg_P_g.Constant7_Value_mok; |
| 15676 | } else { |
| 15677 | fusionAlg_B.Switch_fj = fusionAlg_P_g.Constant8_Value_fm; |
| 15678 | } |
| 15679 | |
| 15680 | /* End of Switch: '<S129>/Switch' */ |
| 15681 | |
| 15682 | /* DataTypeConversion: '<S129>/Data Type Conversion1' */ |
| 15683 | tmp = (real32_T)floor(fusionAlg_B.Selector36_a.DynProp); |
| 15684 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15685 | tmp = 0.0F; |
| 15686 | } else { |
| 15687 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15688 | } |
| 15689 | |
| 15690 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objMotionPattern = (uint8_T) |
| 15691 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15692 | tmp); |
| 15693 | |
| 15694 | /* End of DataTypeConversion: '<S129>/Data Type Conversion1' */ |
| 15695 | |
| 15696 | /* BusCreator: '<S129>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15697 | * Constant: '<S129>/Constant' |
| 15698 | * Constant: '<S129>/Constant1' |
| 15699 | */ |
| 15700 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.reserved.reserved1 = |
| 15701 | fusionAlg_P_g.Constant_Value_dr; |
| 15702 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.reserved.reserved0 = |
| 15703 | fusionAlg_P_g.Constant1_Value_ee; |
| 15704 | |
| 15705 | /* BusCreator: '<S129>/Bus Creator1' incorporates: |
| 15706 | * Constant: '<S129>/Constant10' |
| 15707 | * Constant: '<S129>/Constant2' |
| 15708 | * Constant: '<S129>/Constant3' |
| 15709 | * Constant: '<S129>/Constant4' |
| 15710 | * Constant: '<S129>/Constant5' |
| 15711 | * Constant: '<S129>/Constant6' |
| 15712 | * Constant: '<S129>/Constant9' |
| 15713 | */ |
| 15714 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objObstacleProb = |
| 15715 | fusionAlg_B.Selector36_a.RCS; |
| 15716 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objXPos_Stdev = |
| 15717 | fusionAlg_P_g.Constant2_Value_ki; |
| 15718 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objYPos_Stdev = |
| 15719 | fusionAlg_P_g.Constant3_Value_nk; |
| 15720 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objXVelRel_Stdev = |
| 15721 | fusionAlg_P_g.Constant4_Value_oe; |
| 15722 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objXAccRel = |
| 15723 | fusionAlg_P_g.Constant5_Value_n5; |
| 15724 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objExstProb = |
| 15725 | fusionAlg_P_g.Constant6_Value_gi; |
| 15726 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objYVelRel = |
| 15727 | fusionAlg_B.Selector36_a.VrelLat; |
| 15728 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objXVelRel = |
| 15729 | fusionAlg_B.Selector36_a.VrelLong; |
| 15730 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objXPos = |
| 15731 | fusionAlg_B.Selector36_a.DistLong; |
| 15732 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objYPos = |
| 15733 | fusionAlg_B.Selector36_a.DistLat; |
| 15734 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objID = |
| 15735 | fusionAlg_B.DataTypeConversion_hfo; |
| 15736 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objUpdateFlag = |
| 15737 | fusionAlg_B.Switch_fj; |
| 15738 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objValidFlag = |
| 15739 | fusionAlg_B.Switch_fj; |
| 15740 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objType = |
| 15741 | fusionAlg_P_g.Constant9_Value_nc; |
| 15742 | fusionAlg_B.BusCreator_a.radarObj.radar_37_obj.objMeasFlag = |
| 15743 | fusionAlg_P_g.Constant10_Value_mf1; |
| 15744 | |
| 15745 | /* Selector: '<S97>/Selector37' incorporates: |
| 15746 | * Constant: '<S97>/Constant37' |
| 15747 | */ |
| 15748 | fusionAlg_B.Selector37_l = rtu_Radar308_Info_st-> |
| 15749 | rightFrontRadar_General[fusionAlg_P_g.Constant37_Value_j]; |
| 15750 | |
| 15751 | /* DataTypeConversion: '<S130>/Data Type Conversion' */ |
| 15752 | tmp = (real32_T)floor(fusionAlg_B.Selector37_l.ID); |
| 15753 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15754 | tmp = 0.0F; |
| 15755 | } else { |
| 15756 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15757 | } |
| 15758 | |
| 15759 | fusionAlg_B.DataTypeConversion_b1 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 15760 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15761 | |
| 15762 | /* End of DataTypeConversion: '<S130>/Data Type Conversion' */ |
| 15763 | |
| 15764 | /* Switch: '<S130>/Switch' incorporates: |
| 15765 | * Constant: '<S130>/Constant7' |
| 15766 | * Constant: '<S130>/Constant8' |
| 15767 | */ |
| 15768 | if (fusionAlg_B.DataTypeConversion_b1 > fusionAlg_P_g.Switch_Threshold_k2) { |
| 15769 | fusionAlg_B.Switch_hy = fusionAlg_P_g.Constant7_Value_hj; |
| 15770 | } else { |
| 15771 | fusionAlg_B.Switch_hy = fusionAlg_P_g.Constant8_Value_ff; |
| 15772 | } |
| 15773 | |
| 15774 | /* End of Switch: '<S130>/Switch' */ |
| 15775 | |
| 15776 | /* DataTypeConversion: '<S130>/Data Type Conversion1' */ |
| 15777 | tmp = (real32_T)floor(fusionAlg_B.Selector37_l.DynProp); |
| 15778 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15779 | tmp = 0.0F; |
| 15780 | } else { |
| 15781 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15782 | } |
| 15783 | |
| 15784 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objMotionPattern = (uint8_T) |
| 15785 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15786 | tmp); |
| 15787 | |
| 15788 | /* End of DataTypeConversion: '<S130>/Data Type Conversion1' */ |
| 15789 | |
| 15790 | /* BusCreator: '<S130>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15791 | * Constant: '<S130>/Constant' |
| 15792 | * Constant: '<S130>/Constant1' |
| 15793 | */ |
| 15794 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.reserved.reserved1 = |
| 15795 | fusionAlg_P_g.Constant_Value_i3; |
| 15796 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.reserved.reserved0 = |
| 15797 | fusionAlg_P_g.Constant1_Value_ew; |
| 15798 | |
| 15799 | /* BusCreator: '<S130>/Bus Creator1' incorporates: |
| 15800 | * Constant: '<S130>/Constant10' |
| 15801 | * Constant: '<S130>/Constant2' |
| 15802 | * Constant: '<S130>/Constant3' |
| 15803 | * Constant: '<S130>/Constant4' |
| 15804 | * Constant: '<S130>/Constant5' |
| 15805 | * Constant: '<S130>/Constant6' |
| 15806 | * Constant: '<S130>/Constant9' |
| 15807 | */ |
| 15808 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objObstacleProb = |
| 15809 | fusionAlg_B.Selector37_l.RCS; |
| 15810 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objXPos_Stdev = |
| 15811 | fusionAlg_P_g.Constant2_Value_bs; |
| 15812 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objYPos_Stdev = |
| 15813 | fusionAlg_P_g.Constant3_Value_je; |
| 15814 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objXVelRel_Stdev = |
| 15815 | fusionAlg_P_g.Constant4_Value_dg; |
| 15816 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objXAccRel = |
| 15817 | fusionAlg_P_g.Constant5_Value_h0; |
| 15818 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objExstProb = |
| 15819 | fusionAlg_P_g.Constant6_Value_kf; |
| 15820 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objYVelRel = |
| 15821 | fusionAlg_B.Selector37_l.VrelLat; |
| 15822 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objXVelRel = |
| 15823 | fusionAlg_B.Selector37_l.VrelLong; |
| 15824 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objXPos = |
| 15825 | fusionAlg_B.Selector37_l.DistLong; |
| 15826 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objYPos = |
| 15827 | fusionAlg_B.Selector37_l.DistLat; |
| 15828 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objID = |
| 15829 | fusionAlg_B.DataTypeConversion_b1; |
| 15830 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objUpdateFlag = |
| 15831 | fusionAlg_B.Switch_hy; |
| 15832 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objValidFlag = |
| 15833 | fusionAlg_B.Switch_hy; |
| 15834 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objType = |
| 15835 | fusionAlg_P_g.Constant9_Value_ci; |
| 15836 | fusionAlg_B.BusCreator_a.radarObj.radar_38_obj.objMeasFlag = |
| 15837 | fusionAlg_P_g.Constant10_Value_ey; |
| 15838 | |
| 15839 | /* Selector: '<S97>/Selector38' incorporates: |
| 15840 | * Constant: '<S97>/Constant38' |
| 15841 | */ |
| 15842 | fusionAlg_B.Selector38_a = rtu_Radar308_Info_st-> |
| 15843 | rightFrontRadar_General[fusionAlg_P_g.Constant38_Value_f]; |
| 15844 | |
| 15845 | /* DataTypeConversion: '<S131>/Data Type Conversion' */ |
| 15846 | tmp = (real32_T)floor(fusionAlg_B.Selector38_a.ID); |
| 15847 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15848 | tmp = 0.0F; |
| 15849 | } else { |
| 15850 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15851 | } |
| 15852 | |
| 15853 | fusionAlg_B.DataTypeConversion_fe = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 15854 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15855 | |
| 15856 | /* End of DataTypeConversion: '<S131>/Data Type Conversion' */ |
| 15857 | |
| 15858 | /* Switch: '<S131>/Switch' incorporates: |
| 15859 | * Constant: '<S131>/Constant7' |
| 15860 | * Constant: '<S131>/Constant8' |
| 15861 | */ |
| 15862 | if (fusionAlg_B.DataTypeConversion_fe > fusionAlg_P_g.Switch_Threshold_kx) { |
| 15863 | fusionAlg_B.Switch_ph = fusionAlg_P_g.Constant7_Value_al; |
| 15864 | } else { |
| 15865 | fusionAlg_B.Switch_ph = fusionAlg_P_g.Constant8_Value_ar; |
| 15866 | } |
| 15867 | |
| 15868 | /* End of Switch: '<S131>/Switch' */ |
| 15869 | |
| 15870 | /* DataTypeConversion: '<S131>/Data Type Conversion1' */ |
| 15871 | tmp = (real32_T)floor(fusionAlg_B.Selector38_a.DynProp); |
| 15872 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15873 | tmp = 0.0F; |
| 15874 | } else { |
| 15875 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15876 | } |
| 15877 | |
| 15878 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objMotionPattern = (uint8_T) |
| 15879 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15880 | tmp); |
| 15881 | |
| 15882 | /* End of DataTypeConversion: '<S131>/Data Type Conversion1' */ |
| 15883 | |
| 15884 | /* BusCreator: '<S131>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15885 | * Constant: '<S131>/Constant' |
| 15886 | * Constant: '<S131>/Constant1' |
| 15887 | */ |
| 15888 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.reserved.reserved1 = |
| 15889 | fusionAlg_P_g.Constant_Value_gz; |
| 15890 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.reserved.reserved0 = |
| 15891 | fusionAlg_P_g.Constant1_Value_bt; |
| 15892 | |
| 15893 | /* BusCreator: '<S131>/Bus Creator1' incorporates: |
| 15894 | * Constant: '<S131>/Constant10' |
| 15895 | * Constant: '<S131>/Constant2' |
| 15896 | * Constant: '<S131>/Constant3' |
| 15897 | * Constant: '<S131>/Constant4' |
| 15898 | * Constant: '<S131>/Constant5' |
| 15899 | * Constant: '<S131>/Constant6' |
| 15900 | * Constant: '<S131>/Constant9' |
| 15901 | */ |
| 15902 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objObstacleProb = |
| 15903 | fusionAlg_B.Selector38_a.RCS; |
| 15904 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objXPos_Stdev = |
| 15905 | fusionAlg_P_g.Constant2_Value_bu; |
| 15906 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objYPos_Stdev = |
| 15907 | fusionAlg_P_g.Constant3_Value_n1; |
| 15908 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objXVelRel_Stdev = |
| 15909 | fusionAlg_P_g.Constant4_Value_jr; |
| 15910 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objXAccRel = |
| 15911 | fusionAlg_P_g.Constant5_Value_as; |
| 15912 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objExstProb = |
| 15913 | fusionAlg_P_g.Constant6_Value_f4; |
| 15914 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objYVelRel = |
| 15915 | fusionAlg_B.Selector38_a.VrelLat; |
| 15916 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objXVelRel = |
| 15917 | fusionAlg_B.Selector38_a.VrelLong; |
| 15918 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objXPos = |
| 15919 | fusionAlg_B.Selector38_a.DistLong; |
| 15920 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objYPos = |
| 15921 | fusionAlg_B.Selector38_a.DistLat; |
| 15922 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objID = |
| 15923 | fusionAlg_B.DataTypeConversion_fe; |
| 15924 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objUpdateFlag = |
| 15925 | fusionAlg_B.Switch_ph; |
| 15926 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objValidFlag = |
| 15927 | fusionAlg_B.Switch_ph; |
| 15928 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objType = |
| 15929 | fusionAlg_P_g.Constant9_Value_n1; |
| 15930 | fusionAlg_B.BusCreator_a.radarObj.radar_39_obj.objMeasFlag = |
| 15931 | fusionAlg_P_g.Constant10_Value_ht; |
| 15932 | |
| 15933 | /* Selector: '<S97>/Selector39' incorporates: |
| 15934 | * Constant: '<S97>/Constant39' |
| 15935 | */ |
| 15936 | fusionAlg_B.Selector39_k = rtu_Radar308_Info_st-> |
| 15937 | rightFrontRadar_General[fusionAlg_P_g.Constant39_Value_l]; |
| 15938 | |
| 15939 | /* DataTypeConversion: '<S133>/Data Type Conversion' */ |
| 15940 | tmp = (real32_T)floor(fusionAlg_B.Selector39_k.ID); |
| 15941 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15942 | tmp = 0.0F; |
| 15943 | } else { |
| 15944 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 15945 | } |
| 15946 | |
| 15947 | fusionAlg_B.DataTypeConversion_fi = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 15948 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 15949 | |
| 15950 | /* End of DataTypeConversion: '<S133>/Data Type Conversion' */ |
| 15951 | |
| 15952 | /* Switch: '<S133>/Switch' incorporates: |
| 15953 | * Constant: '<S133>/Constant7' |
| 15954 | * Constant: '<S133>/Constant8' |
| 15955 | */ |
| 15956 | if (fusionAlg_B.DataTypeConversion_fi > fusionAlg_P_g.Switch_Threshold_mb) { |
| 15957 | fusionAlg_B.Switch_ob = fusionAlg_P_g.Constant7_Value_prk; |
| 15958 | } else { |
| 15959 | fusionAlg_B.Switch_ob = fusionAlg_P_g.Constant8_Value_hz; |
| 15960 | } |
| 15961 | |
| 15962 | /* End of Switch: '<S133>/Switch' */ |
| 15963 | |
| 15964 | /* DataTypeConversion: '<S133>/Data Type Conversion1' */ |
| 15965 | tmp = (real32_T)floor(fusionAlg_B.Selector39_k.DynProp); |
| 15966 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 15967 | tmp = 0.0F; |
| 15968 | } else { |
| 15969 | tmp = (real32_T)fmod(tmp, 256.0); |
| 15970 | } |
| 15971 | |
| 15972 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objMotionPattern = (uint8_T) |
| 15973 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 15974 | tmp); |
| 15975 | |
| 15976 | /* End of DataTypeConversion: '<S133>/Data Type Conversion1' */ |
| 15977 | |
| 15978 | /* BusCreator: '<S133>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 15979 | * Constant: '<S133>/Constant' |
| 15980 | * Constant: '<S133>/Constant1' |
| 15981 | */ |
| 15982 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.reserved.reserved1 = |
| 15983 | fusionAlg_P_g.Constant_Value_dqy; |
| 15984 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.reserved.reserved0 = |
| 15985 | fusionAlg_P_g.Constant1_Value_mg; |
| 15986 | |
| 15987 | /* BusCreator: '<S133>/Bus Creator1' incorporates: |
| 15988 | * Constant: '<S133>/Constant10' |
| 15989 | * Constant: '<S133>/Constant2' |
| 15990 | * Constant: '<S133>/Constant3' |
| 15991 | * Constant: '<S133>/Constant4' |
| 15992 | * Constant: '<S133>/Constant5' |
| 15993 | * Constant: '<S133>/Constant6' |
| 15994 | * Constant: '<S133>/Constant9' |
| 15995 | */ |
| 15996 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objObstacleProb = |
| 15997 | fusionAlg_B.Selector39_k.RCS; |
| 15998 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objXPos_Stdev = |
| 15999 | fusionAlg_P_g.Constant2_Value_dv; |
| 16000 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objYPos_Stdev = |
| 16001 | fusionAlg_P_g.Constant3_Value_prw; |
| 16002 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objXVelRel_Stdev = |
| 16003 | fusionAlg_P_g.Constant4_Value_ht; |
| 16004 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objXAccRel = |
| 16005 | fusionAlg_P_g.Constant5_Value_ak; |
| 16006 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objExstProb = |
| 16007 | fusionAlg_P_g.Constant6_Value_d3; |
| 16008 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objYVelRel = |
| 16009 | fusionAlg_B.Selector39_k.VrelLat; |
| 16010 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objXVelRel = |
| 16011 | fusionAlg_B.Selector39_k.VrelLong; |
| 16012 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objXPos = |
| 16013 | fusionAlg_B.Selector39_k.DistLong; |
| 16014 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objYPos = |
| 16015 | fusionAlg_B.Selector39_k.DistLat; |
| 16016 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objID = |
| 16017 | fusionAlg_B.DataTypeConversion_fi; |
| 16018 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objUpdateFlag = |
| 16019 | fusionAlg_B.Switch_ob; |
| 16020 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objValidFlag = |
| 16021 | fusionAlg_B.Switch_ob; |
| 16022 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objType = |
| 16023 | fusionAlg_P_g.Constant9_Value_mt; |
| 16024 | fusionAlg_B.BusCreator_a.radarObj.radar_40_obj.objMeasFlag = |
| 16025 | fusionAlg_P_g.Constant10_Value_cp; |
| 16026 | |
| 16027 | /* DataTypeConversion: '<S98>/Data Type Conversion' */ |
| 16028 | tmp = (real32_T)floor(rtu_Radar308_Info_st->rightFrontRadar_Status.tStamp); |
| 16029 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16030 | tmp = 0.0F; |
| 16031 | } else { |
| 16032 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16033 | } |
| 16034 | |
| 16035 | fusionAlg_B.BusCreator_a.radarState.msgAliveCounter = (uint8_T)(tmp < 0.0F ? |
| 16036 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 16037 | |
| 16038 | /* End of DataTypeConversion: '<S98>/Data Type Conversion' */ |
| 16039 | |
| 16040 | /* BusCreator: '<S98>/Bus Creator2' incorporates: |
| 16041 | * Constant: '<S98>/Constant' |
| 16042 | * Constant: '<S98>/Constant1' |
| 16043 | */ |
| 16044 | fusionAlg_B.BusCreator_a.radarState.reservedField.reserved1 = |
| 16045 | fusionAlg_P_g.Constant_Value_k3; |
| 16046 | fusionAlg_B.BusCreator_a.radarState.reservedField.reserved0 = |
| 16047 | fusionAlg_P_g.Constant1_Value_p3; |
| 16048 | |
| 16049 | /* BusCreator: '<S98>/Bus Creator1' incorporates: |
| 16050 | * Constant: '<S98>/Constant10' |
| 16051 | * Constant: '<S98>/Constant11' |
| 16052 | * Constant: '<S98>/Constant2' |
| 16053 | * Constant: '<S98>/Constant3' |
| 16054 | * Constant: '<S98>/Constant4' |
| 16055 | * Constant: '<S98>/Constant5' |
| 16056 | * Constant: '<S98>/Constant6' |
| 16057 | * Constant: '<S98>/Constant7' |
| 16058 | * Constant: '<S98>/Constant8' |
| 16059 | * Constant: '<S98>/Constant9' |
| 16060 | */ |
| 16061 | fusionAlg_B.BusCreator_a.radarState.hostYaw = fusionAlg_P_g.Constant2_Value_hi; |
| 16062 | fusionAlg_B.BusCreator_a.radarState.hostSpeed = |
| 16063 | fusionAlg_P_g.Constant3_Value_eo; |
| 16064 | fusionAlg_B.BusCreator_a.radarState.timeStamp = |
| 16065 | fusionAlg_P_g.Constant4_Value_bd; |
| 16066 | fusionAlg_B.BusCreator_a.radarState.statusHWErr = |
| 16067 | fusionAlg_P_g.Constant5_Value_jeo; |
| 16068 | fusionAlg_B.BusCreator_a.radarState.statusBlkProg = |
| 16069 | fusionAlg_P_g.Constant6_Value_fsh; |
| 16070 | fusionAlg_B.BusCreator_a.radarState.statusMisAlign = |
| 16071 | fusionAlg_P_g.Constant7_Value_o4; |
| 16072 | fusionAlg_B.BusCreator_a.radarState.sGUFail = fusionAlg_P_g.Constant8_Value_gq; |
| 16073 | fusionAlg_B.BusCreator_a.radarState.measEnabled = |
| 16074 | fusionAlg_P_g.Constant9_Value_bq; |
| 16075 | fusionAlg_B.BusCreator_a.radarState.latency = |
| 16076 | fusionAlg_P_g.Constant10_Value_pa; |
| 16077 | fusionAlg_B.BusCreator_a.radarState.msgCheckSum = |
| 16078 | fusionAlg_P_g.Constant11_Value_c; |
| 16079 | |
| 16080 | /* BusCreator: '<S11>/Bus Creator1' incorporates: |
| 16081 | * Constant: '<S11>/Constant' |
| 16082 | * Constant: '<S11>/Constant1' |
| 16083 | */ |
| 16084 | fusionAlg_B.BusCreator_a.reserved.reserved0 = fusionAlg_P_g.Constant_Value_mz; |
| 16085 | fusionAlg_B.BusCreator_a.reserved.reserved1 = fusionAlg_P_g.Constant1_Value_h; |
| 16086 | |
| 16087 | /* BusCreator: '<S11>/Bus Creator' incorporates: |
| 16088 | * Constant: '<S11>/errType' |
| 16089 | * Constant: '<S11>/timestamp' |
| 16090 | */ |
| 16091 | fusionAlg_B.BusCreator_a.timestamp = fusionAlg_P_g.timestamp_Value_i; |
| 16092 | fusionAlg_B.BusCreator_a.errType = fusionAlg_P_g.errType_Value_a; |
| 16093 | |
| 16094 | /* DataTypeConversion: '<S12>/Data Type Conversion1' */ |
| 16095 | tmp = (real32_T)floor(rtu_Radar308_Info_st->rightRearRadar_Status.Version); |
| 16096 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16097 | tmp = 0.0F; |
| 16098 | } else { |
| 16099 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 16100 | } |
| 16101 | |
| 16102 | fusionAlg_B.BusCreator_ad.frameNum = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 16103 | (uint32_T)-tmp : (uint32_T)tmp; |
| 16104 | |
| 16105 | /* End of DataTypeConversion: '<S12>/Data Type Conversion1' */ |
| 16106 | |
| 16107 | /* DataTypeConversion: '<S12>/Data Type Conversion' */ |
| 16108 | tmp = (real32_T)floor(rtu_Radar308_Info_st->rightRearRadar_Status.ObjNum); |
| 16109 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16110 | tmp = 0.0F; |
| 16111 | } else { |
| 16112 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 16113 | } |
| 16114 | |
| 16115 | fusionAlg_B.BusCreator_ad.count = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 16116 | -tmp : (uint32_T)tmp; |
| 16117 | |
| 16118 | /* End of DataTypeConversion: '<S12>/Data Type Conversion' */ |
| 16119 | |
| 16120 | /* Selector: '<S139>/Selector' incorporates: |
| 16121 | * Constant: '<S139>/Constant' |
| 16122 | */ |
| 16123 | fusionAlg_B.Selector_j = rtu_Radar308_Info_st-> |
| 16124 | rightRearRadar_General[fusionAlg_P_g.Constant_Value_ks]; |
| 16125 | |
| 16126 | /* DataTypeConversion: '<S141>/Data Type Conversion' */ |
| 16127 | tmp = (real32_T)floor(fusionAlg_B.Selector_j.ID); |
| 16128 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16129 | tmp = 0.0F; |
| 16130 | } else { |
| 16131 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16132 | } |
| 16133 | |
| 16134 | fusionAlg_B.DataTypeConversion_ok = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 16135 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16136 | |
| 16137 | /* End of DataTypeConversion: '<S141>/Data Type Conversion' */ |
| 16138 | |
| 16139 | /* Switch: '<S141>/Switch' incorporates: |
| 16140 | * Constant: '<S141>/Constant7' |
| 16141 | * Constant: '<S141>/Constant8' |
| 16142 | */ |
| 16143 | if (fusionAlg_B.DataTypeConversion_ok > fusionAlg_P_g.Switch_Threshold_lmo) { |
| 16144 | fusionAlg_B.Switch_dh = fusionAlg_P_g.Constant7_Value_ej; |
| 16145 | } else { |
| 16146 | fusionAlg_B.Switch_dh = fusionAlg_P_g.Constant8_Value_fw; |
| 16147 | } |
| 16148 | |
| 16149 | /* End of Switch: '<S141>/Switch' */ |
| 16150 | |
| 16151 | /* DataTypeConversion: '<S141>/Data Type Conversion1' */ |
| 16152 | tmp = (real32_T)floor(fusionAlg_B.Selector_j.DynProp); |
| 16153 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16154 | tmp = 0.0F; |
| 16155 | } else { |
| 16156 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16157 | } |
| 16158 | |
| 16159 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objMotionPattern = (uint8_T) |
| 16160 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 16161 | tmp); |
| 16162 | |
| 16163 | /* End of DataTypeConversion: '<S141>/Data Type Conversion1' */ |
| 16164 | |
| 16165 | /* BusCreator: '<S141>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 16166 | * Constant: '<S141>/Constant' |
| 16167 | * Constant: '<S141>/Constant1' |
| 16168 | */ |
| 16169 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.reserved.reserved1 = |
| 16170 | fusionAlg_P_g.Constant_Value_kcm; |
| 16171 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.reserved.reserved0 = |
| 16172 | fusionAlg_P_g.Constant1_Value_gq; |
| 16173 | |
| 16174 | /* BusCreator: '<S141>/Bus Creator1' incorporates: |
| 16175 | * Constant: '<S141>/Constant10' |
| 16176 | * Constant: '<S141>/Constant2' |
| 16177 | * Constant: '<S141>/Constant3' |
| 16178 | * Constant: '<S141>/Constant4' |
| 16179 | * Constant: '<S141>/Constant5' |
| 16180 | * Constant: '<S141>/Constant6' |
| 16181 | * Constant: '<S141>/Constant9' |
| 16182 | */ |
| 16183 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objObstacleProb = |
| 16184 | fusionAlg_B.Selector_j.RCS; |
| 16185 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objXPos_Stdev = |
| 16186 | fusionAlg_P_g.Constant2_Value_ko; |
| 16187 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objYPos_Stdev = |
| 16188 | fusionAlg_P_g.Constant3_Value_b3u; |
| 16189 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objXVelRel_Stdev = |
| 16190 | fusionAlg_P_g.Constant4_Value_pi; |
| 16191 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objXAccRel = |
| 16192 | fusionAlg_P_g.Constant5_Value_bd; |
| 16193 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objExstProb = |
| 16194 | fusionAlg_P_g.Constant6_Value_ls2; |
| 16195 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objYVelRel = |
| 16196 | fusionAlg_B.Selector_j.VrelLat; |
| 16197 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objXVelRel = |
| 16198 | fusionAlg_B.Selector_j.VrelLong; |
| 16199 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objXPos = |
| 16200 | fusionAlg_B.Selector_j.DistLong; |
| 16201 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objYPos = |
| 16202 | fusionAlg_B.Selector_j.DistLat; |
| 16203 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objID = |
| 16204 | fusionAlg_B.DataTypeConversion_ok; |
| 16205 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objUpdateFlag = |
| 16206 | fusionAlg_B.Switch_dh; |
| 16207 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objValidFlag = |
| 16208 | fusionAlg_B.Switch_dh; |
| 16209 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objType = |
| 16210 | fusionAlg_P_g.Constant9_Value_eh; |
| 16211 | fusionAlg_B.BusCreator_ad.radarObj.radar_01_obj.objMeasFlag = |
| 16212 | fusionAlg_P_g.Constant10_Value_jg; |
| 16213 | |
| 16214 | /* Selector: '<S139>/Selector1' incorporates: |
| 16215 | * Constant: '<S139>/Constant1' |
| 16216 | */ |
| 16217 | fusionAlg_B.Selector1_b = rtu_Radar308_Info_st-> |
| 16218 | rightRearRadar_General[fusionAlg_P_g.Constant1_Value_mx]; |
| 16219 | |
| 16220 | /* DataTypeConversion: '<S152>/Data Type Conversion' */ |
| 16221 | tmp = (real32_T)floor(fusionAlg_B.Selector1_b.ID); |
| 16222 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16223 | tmp = 0.0F; |
| 16224 | } else { |
| 16225 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16226 | } |
| 16227 | |
| 16228 | fusionAlg_B.DataTypeConversion_mc = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 16229 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16230 | |
| 16231 | /* End of DataTypeConversion: '<S152>/Data Type Conversion' */ |
| 16232 | |
| 16233 | /* Switch: '<S152>/Switch' incorporates: |
| 16234 | * Constant: '<S152>/Constant7' |
| 16235 | * Constant: '<S152>/Constant8' |
| 16236 | */ |
| 16237 | if (fusionAlg_B.DataTypeConversion_mc > fusionAlg_P_g.Switch_Threshold_bw) { |
| 16238 | fusionAlg_B.Switch_kb = fusionAlg_P_g.Constant7_Value_h2b; |
| 16239 | } else { |
| 16240 | fusionAlg_B.Switch_kb = fusionAlg_P_g.Constant8_Value_dj; |
| 16241 | } |
| 16242 | |
| 16243 | /* End of Switch: '<S152>/Switch' */ |
| 16244 | |
| 16245 | /* DataTypeConversion: '<S152>/Data Type Conversion1' */ |
| 16246 | tmp = (real32_T)floor(fusionAlg_B.Selector1_b.DynProp); |
| 16247 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16248 | tmp = 0.0F; |
| 16249 | } else { |
| 16250 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16251 | } |
| 16252 | |
| 16253 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objMotionPattern = (uint8_T) |
| 16254 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 16255 | tmp); |
| 16256 | |
| 16257 | /* End of DataTypeConversion: '<S152>/Data Type Conversion1' */ |
| 16258 | |
| 16259 | /* BusCreator: '<S152>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 16260 | * Constant: '<S152>/Constant' |
| 16261 | * Constant: '<S152>/Constant1' |
| 16262 | */ |
| 16263 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.reserved.reserved1 = |
| 16264 | fusionAlg_P_g.Constant_Value_nc; |
| 16265 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.reserved.reserved0 = |
| 16266 | fusionAlg_P_g.Constant1_Value_jef; |
| 16267 | |
| 16268 | /* BusCreator: '<S152>/Bus Creator1' incorporates: |
| 16269 | * Constant: '<S152>/Constant10' |
| 16270 | * Constant: '<S152>/Constant2' |
| 16271 | * Constant: '<S152>/Constant3' |
| 16272 | * Constant: '<S152>/Constant4' |
| 16273 | * Constant: '<S152>/Constant5' |
| 16274 | * Constant: '<S152>/Constant6' |
| 16275 | * Constant: '<S152>/Constant9' |
| 16276 | */ |
| 16277 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objObstacleProb = |
| 16278 | fusionAlg_B.Selector1_b.RCS; |
| 16279 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objXPos_Stdev = |
| 16280 | fusionAlg_P_g.Constant2_Value_gs; |
| 16281 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objYPos_Stdev = |
| 16282 | fusionAlg_P_g.Constant3_Value_nk2; |
| 16283 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objXVelRel_Stdev = |
| 16284 | fusionAlg_P_g.Constant4_Value_ey; |
| 16285 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objXAccRel = |
| 16286 | fusionAlg_P_g.Constant5_Value_ao; |
| 16287 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objExstProb = |
| 16288 | fusionAlg_P_g.Constant6_Value_f0; |
| 16289 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objYVelRel = |
| 16290 | fusionAlg_B.Selector1_b.VrelLat; |
| 16291 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objXVelRel = |
| 16292 | fusionAlg_B.Selector1_b.VrelLong; |
| 16293 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objXPos = |
| 16294 | fusionAlg_B.Selector1_b.DistLong; |
| 16295 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objYPos = |
| 16296 | fusionAlg_B.Selector1_b.DistLat; |
| 16297 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objID = |
| 16298 | fusionAlg_B.DataTypeConversion_mc; |
| 16299 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objUpdateFlag = |
| 16300 | fusionAlg_B.Switch_kb; |
| 16301 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objValidFlag = |
| 16302 | fusionAlg_B.Switch_kb; |
| 16303 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objType = |
| 16304 | fusionAlg_P_g.Constant9_Value_br; |
| 16305 | fusionAlg_B.BusCreator_ad.radarObj.radar_02_obj.objMeasFlag = |
| 16306 | fusionAlg_P_g.Constant10_Value_px; |
| 16307 | |
| 16308 | /* Selector: '<S139>/Selector2' incorporates: |
| 16309 | * Constant: '<S139>/Constant2' |
| 16310 | */ |
| 16311 | fusionAlg_B.Selector2_d = rtu_Radar308_Info_st-> |
| 16312 | rightRearRadar_General[fusionAlg_P_g.Constant2_Value_ps]; |
| 16313 | |
| 16314 | /* DataTypeConversion: '<S163>/Data Type Conversion' */ |
| 16315 | tmp = (real32_T)floor(fusionAlg_B.Selector2_d.ID); |
| 16316 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16317 | tmp = 0.0F; |
| 16318 | } else { |
| 16319 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16320 | } |
| 16321 | |
| 16322 | fusionAlg_B.DataTypeConversion_mt = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 16323 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16324 | |
| 16325 | /* End of DataTypeConversion: '<S163>/Data Type Conversion' */ |
| 16326 | |
| 16327 | /* Switch: '<S163>/Switch' incorporates: |
| 16328 | * Constant: '<S163>/Constant7' |
| 16329 | * Constant: '<S163>/Constant8' |
| 16330 | */ |
| 16331 | if (fusionAlg_B.DataTypeConversion_mt > fusionAlg_P_g.Switch_Threshold_kw) { |
| 16332 | fusionAlg_B.Switch_g4 = fusionAlg_P_g.Constant7_Value_lj; |
| 16333 | } else { |
| 16334 | fusionAlg_B.Switch_g4 = fusionAlg_P_g.Constant8_Value_l4; |
| 16335 | } |
| 16336 | |
| 16337 | /* End of Switch: '<S163>/Switch' */ |
| 16338 | |
| 16339 | /* DataTypeConversion: '<S163>/Data Type Conversion1' */ |
| 16340 | tmp = (real32_T)floor(fusionAlg_B.Selector2_d.DynProp); |
| 16341 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16342 | tmp = 0.0F; |
| 16343 | } else { |
| 16344 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16345 | } |
| 16346 | |
| 16347 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objMotionPattern = (uint8_T) |
| 16348 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 16349 | tmp); |
| 16350 | |
| 16351 | /* End of DataTypeConversion: '<S163>/Data Type Conversion1' */ |
| 16352 | |
| 16353 | /* BusCreator: '<S163>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 16354 | * Constant: '<S163>/Constant' |
| 16355 | * Constant: '<S163>/Constant1' |
| 16356 | */ |
| 16357 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.reserved.reserved1 = |
| 16358 | fusionAlg_P_g.Constant_Value_irs; |
| 16359 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.reserved.reserved0 = |
| 16360 | fusionAlg_P_g.Constant1_Value_aty; |
| 16361 | |
| 16362 | /* BusCreator: '<S163>/Bus Creator1' incorporates: |
| 16363 | * Constant: '<S163>/Constant10' |
| 16364 | * Constant: '<S163>/Constant2' |
| 16365 | * Constant: '<S163>/Constant3' |
| 16366 | * Constant: '<S163>/Constant4' |
| 16367 | * Constant: '<S163>/Constant5' |
| 16368 | * Constant: '<S163>/Constant6' |
| 16369 | * Constant: '<S163>/Constant9' |
| 16370 | */ |
| 16371 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objObstacleProb = |
| 16372 | fusionAlg_B.Selector2_d.RCS; |
| 16373 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objXPos_Stdev = |
| 16374 | fusionAlg_P_g.Constant2_Value_hh; |
| 16375 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objYPos_Stdev = |
| 16376 | fusionAlg_P_g.Constant3_Value_my; |
| 16377 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objXVelRel_Stdev = |
| 16378 | fusionAlg_P_g.Constant4_Value_a4; |
| 16379 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objXAccRel = |
| 16380 | fusionAlg_P_g.Constant5_Value_eg; |
| 16381 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objExstProb = |
| 16382 | fusionAlg_P_g.Constant6_Value_go; |
| 16383 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objYVelRel = |
| 16384 | fusionAlg_B.Selector2_d.VrelLat; |
| 16385 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objXVelRel = |
| 16386 | fusionAlg_B.Selector2_d.VrelLong; |
| 16387 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objXPos = |
| 16388 | fusionAlg_B.Selector2_d.DistLong; |
| 16389 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objYPos = |
| 16390 | fusionAlg_B.Selector2_d.DistLat; |
| 16391 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objID = |
| 16392 | fusionAlg_B.DataTypeConversion_mt; |
| 16393 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objUpdateFlag = |
| 16394 | fusionAlg_B.Switch_g4; |
| 16395 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objValidFlag = |
| 16396 | fusionAlg_B.Switch_g4; |
| 16397 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objType = |
| 16398 | fusionAlg_P_g.Constant9_Value_hy; |
| 16399 | fusionAlg_B.BusCreator_ad.radarObj.radar_03_obj.objMeasFlag = |
| 16400 | fusionAlg_P_g.Constant10_Value_fa; |
| 16401 | |
| 16402 | /* Selector: '<S139>/Selector3' incorporates: |
| 16403 | * Constant: '<S139>/Constant3' |
| 16404 | */ |
| 16405 | fusionAlg_B.Selector3_e = rtu_Radar308_Info_st-> |
| 16406 | rightRearRadar_General[fusionAlg_P_g.Constant3_Value_ir]; |
| 16407 | |
| 16408 | /* DataTypeConversion: '<S174>/Data Type Conversion' */ |
| 16409 | tmp = (real32_T)floor(fusionAlg_B.Selector3_e.ID); |
| 16410 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16411 | tmp = 0.0F; |
| 16412 | } else { |
| 16413 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16414 | } |
| 16415 | |
| 16416 | fusionAlg_B.DataTypeConversion_ia = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 16417 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16418 | |
| 16419 | /* End of DataTypeConversion: '<S174>/Data Type Conversion' */ |
| 16420 | |
| 16421 | /* Switch: '<S174>/Switch' incorporates: |
| 16422 | * Constant: '<S174>/Constant7' |
| 16423 | * Constant: '<S174>/Constant8' |
| 16424 | */ |
| 16425 | if (fusionAlg_B.DataTypeConversion_ia > fusionAlg_P_g.Switch_Threshold_cw) { |
| 16426 | fusionAlg_B.Switch_hl = fusionAlg_P_g.Constant7_Value_ga; |
| 16427 | } else { |
| 16428 | fusionAlg_B.Switch_hl = fusionAlg_P_g.Constant8_Value_dn; |
| 16429 | } |
| 16430 | |
| 16431 | /* End of Switch: '<S174>/Switch' */ |
| 16432 | |
| 16433 | /* DataTypeConversion: '<S174>/Data Type Conversion1' */ |
| 16434 | tmp = (real32_T)floor(fusionAlg_B.Selector3_e.DynProp); |
| 16435 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16436 | tmp = 0.0F; |
| 16437 | } else { |
| 16438 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16439 | } |
| 16440 | |
| 16441 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objMotionPattern = (uint8_T) |
| 16442 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 16443 | tmp); |
| 16444 | |
| 16445 | /* End of DataTypeConversion: '<S174>/Data Type Conversion1' */ |
| 16446 | |
| 16447 | /* BusCreator: '<S174>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 16448 | * Constant: '<S174>/Constant' |
| 16449 | * Constant: '<S174>/Constant1' |
| 16450 | */ |
| 16451 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.reserved.reserved1 = |
| 16452 | fusionAlg_P_g.Constant_Value_nnk; |
| 16453 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.reserved.reserved0 = |
| 16454 | fusionAlg_P_g.Constant1_Value_cy; |
| 16455 | |
| 16456 | /* BusCreator: '<S174>/Bus Creator1' incorporates: |
| 16457 | * Constant: '<S174>/Constant10' |
| 16458 | * Constant: '<S174>/Constant2' |
| 16459 | * Constant: '<S174>/Constant3' |
| 16460 | * Constant: '<S174>/Constant4' |
| 16461 | * Constant: '<S174>/Constant5' |
| 16462 | * Constant: '<S174>/Constant6' |
| 16463 | * Constant: '<S174>/Constant9' |
| 16464 | */ |
| 16465 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objObstacleProb = |
| 16466 | fusionAlg_B.Selector3_e.RCS; |
| 16467 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objXPos_Stdev = |
| 16468 | fusionAlg_P_g.Constant2_Value_a2; |
| 16469 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objYPos_Stdev = |
| 16470 | fusionAlg_P_g.Constant3_Value_jo; |
| 16471 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objXVelRel_Stdev = |
| 16472 | fusionAlg_P_g.Constant4_Value_ke; |
| 16473 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objXAccRel = |
| 16474 | fusionAlg_P_g.Constant5_Value_f41; |
| 16475 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objExstProb = |
| 16476 | fusionAlg_P_g.Constant6_Value_aw; |
| 16477 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objYVelRel = |
| 16478 | fusionAlg_B.Selector3_e.VrelLat; |
| 16479 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objXVelRel = |
| 16480 | fusionAlg_B.Selector3_e.VrelLong; |
| 16481 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objXPos = |
| 16482 | fusionAlg_B.Selector3_e.DistLong; |
| 16483 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objYPos = |
| 16484 | fusionAlg_B.Selector3_e.DistLat; |
| 16485 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objID = |
| 16486 | fusionAlg_B.DataTypeConversion_ia; |
| 16487 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objUpdateFlag = |
| 16488 | fusionAlg_B.Switch_hl; |
| 16489 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objValidFlag = |
| 16490 | fusionAlg_B.Switch_hl; |
| 16491 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objType = |
| 16492 | fusionAlg_P_g.Constant9_Value_g5; |
| 16493 | fusionAlg_B.BusCreator_ad.radarObj.radar_04_obj.objMeasFlag = |
| 16494 | fusionAlg_P_g.Constant10_Value_ct; |
| 16495 | |
| 16496 | /* Selector: '<S139>/Selector4' incorporates: |
| 16497 | * Constant: '<S139>/Constant4' |
| 16498 | */ |
| 16499 | fusionAlg_B.Selector4_i = rtu_Radar308_Info_st-> |
| 16500 | rightRearRadar_General[fusionAlg_P_g.Constant4_Value_dw3]; |
| 16501 | |
| 16502 | /* DataTypeConversion: '<S176>/Data Type Conversion' */ |
| 16503 | tmp = (real32_T)floor(fusionAlg_B.Selector4_i.ID); |
| 16504 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16505 | tmp = 0.0F; |
| 16506 | } else { |
| 16507 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16508 | } |
| 16509 | |
| 16510 | fusionAlg_B.DataTypeConversion_he = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 16511 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16512 | |
| 16513 | /* End of DataTypeConversion: '<S176>/Data Type Conversion' */ |
| 16514 | |
| 16515 | /* Switch: '<S176>/Switch' incorporates: |
| 16516 | * Constant: '<S176>/Constant7' |
| 16517 | * Constant: '<S176>/Constant8' |
| 16518 | */ |
| 16519 | if (fusionAlg_B.DataTypeConversion_he > fusionAlg_P_g.Switch_Threshold_hb) { |
| 16520 | fusionAlg_B.Switch_g1 = fusionAlg_P_g.Constant7_Value_ak; |
| 16521 | } else { |
| 16522 | fusionAlg_B.Switch_g1 = fusionAlg_P_g.Constant8_Value_ks; |
| 16523 | } |
| 16524 | |
| 16525 | /* End of Switch: '<S176>/Switch' */ |
| 16526 | |
| 16527 | /* DataTypeConversion: '<S176>/Data Type Conversion1' */ |
| 16528 | tmp = (real32_T)floor(fusionAlg_B.Selector4_i.DynProp); |
| 16529 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16530 | tmp = 0.0F; |
| 16531 | } else { |
| 16532 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16533 | } |
| 16534 | |
| 16535 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objMotionPattern = (uint8_T) |
| 16536 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 16537 | tmp); |
| 16538 | |
| 16539 | /* End of DataTypeConversion: '<S176>/Data Type Conversion1' */ |
| 16540 | |
| 16541 | /* BusCreator: '<S176>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 16542 | * Constant: '<S176>/Constant' |
| 16543 | * Constant: '<S176>/Constant1' |
| 16544 | */ |
| 16545 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.reserved.reserved1 = |
| 16546 | fusionAlg_P_g.Constant_Value_fz; |
| 16547 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.reserved.reserved0 = |
| 16548 | fusionAlg_P_g.Constant1_Value_onn; |
| 16549 | |
| 16550 | /* BusCreator: '<S176>/Bus Creator1' incorporates: |
| 16551 | * Constant: '<S176>/Constant10' |
| 16552 | * Constant: '<S176>/Constant2' |
| 16553 | * Constant: '<S176>/Constant3' |
| 16554 | * Constant: '<S176>/Constant4' |
| 16555 | * Constant: '<S176>/Constant5' |
| 16556 | * Constant: '<S176>/Constant6' |
| 16557 | * Constant: '<S176>/Constant9' |
| 16558 | */ |
| 16559 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objObstacleProb = |
| 16560 | fusionAlg_B.Selector4_i.RCS; |
| 16561 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objXPos_Stdev = |
| 16562 | fusionAlg_P_g.Constant2_Value_h0; |
| 16563 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objYPos_Stdev = |
| 16564 | fusionAlg_P_g.Constant3_Value_cnt; |
| 16565 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objXVelRel_Stdev = |
| 16566 | fusionAlg_P_g.Constant4_Value_bw; |
| 16567 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objXAccRel = |
| 16568 | fusionAlg_P_g.Constant5_Value_dh; |
| 16569 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objExstProb = |
| 16570 | fusionAlg_P_g.Constant6_Value_ct; |
| 16571 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objYVelRel = |
| 16572 | fusionAlg_B.Selector4_i.VrelLat; |
| 16573 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objXVelRel = |
| 16574 | fusionAlg_B.Selector4_i.VrelLong; |
| 16575 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objXPos = |
| 16576 | fusionAlg_B.Selector4_i.DistLong; |
| 16577 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objYPos = |
| 16578 | fusionAlg_B.Selector4_i.DistLat; |
| 16579 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objID = |
| 16580 | fusionAlg_B.DataTypeConversion_he; |
| 16581 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objUpdateFlag = |
| 16582 | fusionAlg_B.Switch_g1; |
| 16583 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objValidFlag = |
| 16584 | fusionAlg_B.Switch_g1; |
| 16585 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objType = |
| 16586 | fusionAlg_P_g.Constant9_Value_ag; |
| 16587 | fusionAlg_B.BusCreator_ad.radarObj.radar_05_obj.objMeasFlag = |
| 16588 | fusionAlg_P_g.Constant10_Value_da; |
| 16589 | |
| 16590 | /* Selector: '<S139>/Selector5' incorporates: |
| 16591 | * Constant: '<S139>/Constant5' |
| 16592 | */ |
| 16593 | fusionAlg_B.Selector5_b = rtu_Radar308_Info_st-> |
| 16594 | rightRearRadar_General[fusionAlg_P_g.Constant5_Value_iw]; |
| 16595 | |
| 16596 | /* DataTypeConversion: '<S177>/Data Type Conversion' */ |
| 16597 | tmp = (real32_T)floor(fusionAlg_B.Selector5_b.ID); |
| 16598 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16599 | tmp = 0.0F; |
| 16600 | } else { |
| 16601 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16602 | } |
| 16603 | |
| 16604 | fusionAlg_B.DataTypeConversion_fh = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 16605 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16606 | |
| 16607 | /* End of DataTypeConversion: '<S177>/Data Type Conversion' */ |
| 16608 | |
| 16609 | /* Switch: '<S177>/Switch' incorporates: |
| 16610 | * Constant: '<S177>/Constant7' |
| 16611 | * Constant: '<S177>/Constant8' |
| 16612 | */ |
| 16613 | if (fusionAlg_B.DataTypeConversion_fh > fusionAlg_P_g.Switch_Threshold_gg) { |
| 16614 | fusionAlg_B.Switch_ko = fusionAlg_P_g.Constant7_Value_eg; |
| 16615 | } else { |
| 16616 | fusionAlg_B.Switch_ko = fusionAlg_P_g.Constant8_Value_lw; |
| 16617 | } |
| 16618 | |
| 16619 | /* End of Switch: '<S177>/Switch' */ |
| 16620 | |
| 16621 | /* DataTypeConversion: '<S177>/Data Type Conversion1' */ |
| 16622 | tmp = (real32_T)floor(fusionAlg_B.Selector5_b.DynProp); |
| 16623 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16624 | tmp = 0.0F; |
| 16625 | } else { |
| 16626 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16627 | } |
| 16628 | |
| 16629 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objMotionPattern = (uint8_T) |
| 16630 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 16631 | tmp); |
| 16632 | |
| 16633 | /* End of DataTypeConversion: '<S177>/Data Type Conversion1' */ |
| 16634 | |
| 16635 | /* BusCreator: '<S177>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 16636 | * Constant: '<S177>/Constant' |
| 16637 | * Constant: '<S177>/Constant1' |
| 16638 | */ |
| 16639 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.reserved.reserved1 = |
| 16640 | fusionAlg_P_g.Constant_Value_alk; |
| 16641 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.reserved.reserved0 = |
| 16642 | fusionAlg_P_g.Constant1_Value_g2f; |
| 16643 | |
| 16644 | /* BusCreator: '<S177>/Bus Creator1' incorporates: |
| 16645 | * Constant: '<S177>/Constant10' |
| 16646 | * Constant: '<S177>/Constant2' |
| 16647 | * Constant: '<S177>/Constant3' |
| 16648 | * Constant: '<S177>/Constant4' |
| 16649 | * Constant: '<S177>/Constant5' |
| 16650 | * Constant: '<S177>/Constant6' |
| 16651 | * Constant: '<S177>/Constant9' |
| 16652 | */ |
| 16653 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objObstacleProb = |
| 16654 | fusionAlg_B.Selector5_b.RCS; |
| 16655 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objXPos_Stdev = |
| 16656 | fusionAlg_P_g.Constant2_Value_eg; |
| 16657 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objYPos_Stdev = |
| 16658 | fusionAlg_P_g.Constant3_Value_gx; |
| 16659 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objXVelRel_Stdev = |
| 16660 | fusionAlg_P_g.Constant4_Value_jj; |
| 16661 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objXAccRel = |
| 16662 | fusionAlg_P_g.Constant5_Value_kf; |
| 16663 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objExstProb = |
| 16664 | fusionAlg_P_g.Constant6_Value_ny; |
| 16665 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objYVelRel = |
| 16666 | fusionAlg_B.Selector5_b.VrelLat; |
| 16667 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objXVelRel = |
| 16668 | fusionAlg_B.Selector5_b.VrelLong; |
| 16669 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objXPos = |
| 16670 | fusionAlg_B.Selector5_b.DistLong; |
| 16671 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objYPos = |
| 16672 | fusionAlg_B.Selector5_b.DistLat; |
| 16673 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objID = |
| 16674 | fusionAlg_B.DataTypeConversion_fh; |
| 16675 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objUpdateFlag = |
| 16676 | fusionAlg_B.Switch_ko; |
| 16677 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objValidFlag = |
| 16678 | fusionAlg_B.Switch_ko; |
| 16679 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objType = |
| 16680 | fusionAlg_P_g.Constant9_Value_pq; |
| 16681 | fusionAlg_B.BusCreator_ad.radarObj.radar_06_obj.objMeasFlag = |
| 16682 | fusionAlg_P_g.Constant10_Value_lj; |
| 16683 | |
| 16684 | /* Selector: '<S139>/Selector6' incorporates: |
| 16685 | * Constant: '<S139>/Constant6' |
| 16686 | */ |
| 16687 | fusionAlg_B.Selector6_f = rtu_Radar308_Info_st-> |
| 16688 | rightRearRadar_General[fusionAlg_P_g.Constant6_Value_bm]; |
| 16689 | |
| 16690 | /* DataTypeConversion: '<S178>/Data Type Conversion' */ |
| 16691 | tmp = (real32_T)floor(fusionAlg_B.Selector6_f.ID); |
| 16692 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16693 | tmp = 0.0F; |
| 16694 | } else { |
| 16695 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16696 | } |
| 16697 | |
| 16698 | fusionAlg_B.DataTypeConversion_ca = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 16699 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16700 | |
| 16701 | /* End of DataTypeConversion: '<S178>/Data Type Conversion' */ |
| 16702 | |
| 16703 | /* Switch: '<S178>/Switch' incorporates: |
| 16704 | * Constant: '<S178>/Constant7' |
| 16705 | * Constant: '<S178>/Constant8' |
| 16706 | */ |
| 16707 | if (fusionAlg_B.DataTypeConversion_ca > fusionAlg_P_g.Switch_Threshold_hnr) { |
| 16708 | fusionAlg_B.Switch_pa = fusionAlg_P_g.Constant7_Value_be; |
| 16709 | } else { |
| 16710 | fusionAlg_B.Switch_pa = fusionAlg_P_g.Constant8_Value_ac; |
| 16711 | } |
| 16712 | |
| 16713 | /* End of Switch: '<S178>/Switch' */ |
| 16714 | |
| 16715 | /* DataTypeConversion: '<S178>/Data Type Conversion1' */ |
| 16716 | tmp = (real32_T)floor(fusionAlg_B.Selector6_f.DynProp); |
| 16717 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16718 | tmp = 0.0F; |
| 16719 | } else { |
| 16720 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16721 | } |
| 16722 | |
| 16723 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objMotionPattern = (uint8_T) |
| 16724 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 16725 | tmp); |
| 16726 | |
| 16727 | /* End of DataTypeConversion: '<S178>/Data Type Conversion1' */ |
| 16728 | |
| 16729 | /* BusCreator: '<S178>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 16730 | * Constant: '<S178>/Constant' |
| 16731 | * Constant: '<S178>/Constant1' |
| 16732 | */ |
| 16733 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.reserved.reserved1 = |
| 16734 | fusionAlg_P_g.Constant_Value_dt; |
| 16735 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.reserved.reserved0 = |
| 16736 | fusionAlg_P_g.Constant1_Value_age; |
| 16737 | |
| 16738 | /* BusCreator: '<S178>/Bus Creator1' incorporates: |
| 16739 | * Constant: '<S178>/Constant10' |
| 16740 | * Constant: '<S178>/Constant2' |
| 16741 | * Constant: '<S178>/Constant3' |
| 16742 | * Constant: '<S178>/Constant4' |
| 16743 | * Constant: '<S178>/Constant5' |
| 16744 | * Constant: '<S178>/Constant6' |
| 16745 | * Constant: '<S178>/Constant9' |
| 16746 | */ |
| 16747 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objObstacleProb = |
| 16748 | fusionAlg_B.Selector6_f.RCS; |
| 16749 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objXPos_Stdev = |
| 16750 | fusionAlg_P_g.Constant2_Value_lv; |
| 16751 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objYPos_Stdev = |
| 16752 | fusionAlg_P_g.Constant3_Value_dd; |
| 16753 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objXVelRel_Stdev = |
| 16754 | fusionAlg_P_g.Constant4_Value_ei; |
| 16755 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objXAccRel = |
| 16756 | fusionAlg_P_g.Constant5_Value_ef; |
| 16757 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objExstProb = |
| 16758 | fusionAlg_P_g.Constant6_Value_bu; |
| 16759 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objYVelRel = |
| 16760 | fusionAlg_B.Selector6_f.VrelLat; |
| 16761 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objXVelRel = |
| 16762 | fusionAlg_B.Selector6_f.VrelLong; |
| 16763 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objXPos = |
| 16764 | fusionAlg_B.Selector6_f.DistLong; |
| 16765 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objYPos = |
| 16766 | fusionAlg_B.Selector6_f.DistLat; |
| 16767 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objID = |
| 16768 | fusionAlg_B.DataTypeConversion_ca; |
| 16769 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objUpdateFlag = |
| 16770 | fusionAlg_B.Switch_pa; |
| 16771 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objValidFlag = |
| 16772 | fusionAlg_B.Switch_pa; |
| 16773 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objType = |
| 16774 | fusionAlg_P_g.Constant9_Value_ps; |
| 16775 | fusionAlg_B.BusCreator_ad.radarObj.radar_07_obj.objMeasFlag = |
| 16776 | fusionAlg_P_g.Constant10_Value_lr; |
| 16777 | |
| 16778 | /* Selector: '<S139>/Selector7' incorporates: |
| 16779 | * Constant: '<S139>/Constant7' |
| 16780 | */ |
| 16781 | fusionAlg_B.Selector7_d = rtu_Radar308_Info_st-> |
| 16782 | rightRearRadar_General[fusionAlg_P_g.Constant7_Value_mk4]; |
| 16783 | |
| 16784 | /* DataTypeConversion: '<S179>/Data Type Conversion' */ |
| 16785 | tmp = (real32_T)floor(fusionAlg_B.Selector7_d.ID); |
| 16786 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16787 | tmp = 0.0F; |
| 16788 | } else { |
| 16789 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16790 | } |
| 16791 | |
| 16792 | fusionAlg_B.DataTypeConversion_nu = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 16793 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16794 | |
| 16795 | /* End of DataTypeConversion: '<S179>/Data Type Conversion' */ |
| 16796 | |
| 16797 | /* Switch: '<S179>/Switch' incorporates: |
| 16798 | * Constant: '<S179>/Constant7' |
| 16799 | * Constant: '<S179>/Constant8' |
| 16800 | */ |
| 16801 | if (fusionAlg_B.DataTypeConversion_nu > fusionAlg_P_g.Switch_Threshold_mu) { |
| 16802 | fusionAlg_B.Switch_kpx = fusionAlg_P_g.Constant7_Value_ly; |
| 16803 | } else { |
| 16804 | fusionAlg_B.Switch_kpx = fusionAlg_P_g.Constant8_Value_aoi; |
| 16805 | } |
| 16806 | |
| 16807 | /* End of Switch: '<S179>/Switch' */ |
| 16808 | |
| 16809 | /* DataTypeConversion: '<S179>/Data Type Conversion1' */ |
| 16810 | tmp = (real32_T)floor(fusionAlg_B.Selector7_d.DynProp); |
| 16811 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16812 | tmp = 0.0F; |
| 16813 | } else { |
| 16814 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16815 | } |
| 16816 | |
| 16817 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objMotionPattern = (uint8_T) |
| 16818 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 16819 | tmp); |
| 16820 | |
| 16821 | /* End of DataTypeConversion: '<S179>/Data Type Conversion1' */ |
| 16822 | |
| 16823 | /* BusCreator: '<S179>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 16824 | * Constant: '<S179>/Constant' |
| 16825 | * Constant: '<S179>/Constant1' |
| 16826 | */ |
| 16827 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.reserved.reserved1 = |
| 16828 | fusionAlg_P_g.Constant_Value_nev; |
| 16829 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.reserved.reserved0 = |
| 16830 | fusionAlg_P_g.Constant1_Value_ira; |
| 16831 | |
| 16832 | /* BusCreator: '<S179>/Bus Creator1' incorporates: |
| 16833 | * Constant: '<S179>/Constant10' |
| 16834 | * Constant: '<S179>/Constant2' |
| 16835 | * Constant: '<S179>/Constant3' |
| 16836 | * Constant: '<S179>/Constant4' |
| 16837 | * Constant: '<S179>/Constant5' |
| 16838 | * Constant: '<S179>/Constant6' |
| 16839 | * Constant: '<S179>/Constant9' |
| 16840 | */ |
| 16841 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objObstacleProb = |
| 16842 | fusionAlg_B.Selector7_d.RCS; |
| 16843 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objXPos_Stdev = |
| 16844 | fusionAlg_P_g.Constant2_Value_ob; |
| 16845 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objYPos_Stdev = |
| 16846 | fusionAlg_P_g.Constant3_Value_kq; |
| 16847 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objXVelRel_Stdev = |
| 16848 | fusionAlg_P_g.Constant4_Value_ie; |
| 16849 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objXAccRel = |
| 16850 | fusionAlg_P_g.Constant5_Value_mc; |
| 16851 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objExstProb = |
| 16852 | fusionAlg_P_g.Constant6_Value_ag; |
| 16853 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objYVelRel = |
| 16854 | fusionAlg_B.Selector7_d.VrelLat; |
| 16855 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objXVelRel = |
| 16856 | fusionAlg_B.Selector7_d.VrelLong; |
| 16857 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objXPos = |
| 16858 | fusionAlg_B.Selector7_d.DistLong; |
| 16859 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objYPos = |
| 16860 | fusionAlg_B.Selector7_d.DistLat; |
| 16861 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objID = |
| 16862 | fusionAlg_B.DataTypeConversion_nu; |
| 16863 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objUpdateFlag = |
| 16864 | fusionAlg_B.Switch_kpx; |
| 16865 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objValidFlag = |
| 16866 | fusionAlg_B.Switch_kpx; |
| 16867 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objType = |
| 16868 | fusionAlg_P_g.Constant9_Value_np; |
| 16869 | fusionAlg_B.BusCreator_ad.radarObj.radar_08_obj.objMeasFlag = |
| 16870 | fusionAlg_P_g.Constant10_Value_eq; |
| 16871 | |
| 16872 | /* Selector: '<S139>/Selector8' incorporates: |
| 16873 | * Constant: '<S139>/Constant8' |
| 16874 | */ |
| 16875 | fusionAlg_B.Selector8_p = rtu_Radar308_Info_st-> |
| 16876 | rightRearRadar_General[fusionAlg_P_g.Constant8_Value_b3]; |
| 16877 | |
| 16878 | /* DataTypeConversion: '<S180>/Data Type Conversion' */ |
| 16879 | tmp = (real32_T)floor(fusionAlg_B.Selector8_p.ID); |
| 16880 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16881 | tmp = 0.0F; |
| 16882 | } else { |
| 16883 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16884 | } |
| 16885 | |
| 16886 | fusionAlg_B.DataTypeConversion_glw = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 16887 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16888 | |
| 16889 | /* End of DataTypeConversion: '<S180>/Data Type Conversion' */ |
| 16890 | |
| 16891 | /* Switch: '<S180>/Switch' incorporates: |
| 16892 | * Constant: '<S180>/Constant7' |
| 16893 | * Constant: '<S180>/Constant8' |
| 16894 | */ |
| 16895 | if (fusionAlg_B.DataTypeConversion_glw > fusionAlg_P_g.Switch_Threshold_ev) { |
| 16896 | fusionAlg_B.Switch_ei = fusionAlg_P_g.Constant7_Value_li; |
| 16897 | } else { |
| 16898 | fusionAlg_B.Switch_ei = fusionAlg_P_g.Constant8_Value_aw; |
| 16899 | } |
| 16900 | |
| 16901 | /* End of Switch: '<S180>/Switch' */ |
| 16902 | |
| 16903 | /* DataTypeConversion: '<S180>/Data Type Conversion1' */ |
| 16904 | tmp = (real32_T)floor(fusionAlg_B.Selector8_p.DynProp); |
| 16905 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16906 | tmp = 0.0F; |
| 16907 | } else { |
| 16908 | tmp = (real32_T)fmod(tmp, 256.0); |
| 16909 | } |
| 16910 | |
| 16911 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objMotionPattern = (uint8_T) |
| 16912 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 16913 | tmp); |
| 16914 | |
| 16915 | /* End of DataTypeConversion: '<S180>/Data Type Conversion1' */ |
| 16916 | |
| 16917 | /* BusCreator: '<S180>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 16918 | * Constant: '<S180>/Constant' |
| 16919 | * Constant: '<S180>/Constant1' |
| 16920 | */ |
| 16921 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.reserved.reserved1 = |
| 16922 | fusionAlg_P_g.Constant_Value_ox; |
| 16923 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.reserved.reserved0 = |
| 16924 | fusionAlg_P_g.Constant1_Value_iu; |
| 16925 | |
| 16926 | /* BusCreator: '<S180>/Bus Creator1' incorporates: |
| 16927 | * Constant: '<S180>/Constant10' |
| 16928 | * Constant: '<S180>/Constant2' |
| 16929 | * Constant: '<S180>/Constant3' |
| 16930 | * Constant: '<S180>/Constant4' |
| 16931 | * Constant: '<S180>/Constant5' |
| 16932 | * Constant: '<S180>/Constant6' |
| 16933 | * Constant: '<S180>/Constant9' |
| 16934 | */ |
| 16935 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objObstacleProb = |
| 16936 | fusionAlg_B.Selector8_p.RCS; |
| 16937 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objXPos_Stdev = |
| 16938 | fusionAlg_P_g.Constant2_Value_ma; |
| 16939 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objYPos_Stdev = |
| 16940 | fusionAlg_P_g.Constant3_Value_gi; |
| 16941 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objXVelRel_Stdev = |
| 16942 | fusionAlg_P_g.Constant4_Value_fq; |
| 16943 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objXAccRel = |
| 16944 | fusionAlg_P_g.Constant5_Value_ib; |
| 16945 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objExstProb = |
| 16946 | fusionAlg_P_g.Constant6_Value_oh; |
| 16947 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objYVelRel = |
| 16948 | fusionAlg_B.Selector8_p.VrelLat; |
| 16949 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objXVelRel = |
| 16950 | fusionAlg_B.Selector8_p.VrelLong; |
| 16951 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objXPos = |
| 16952 | fusionAlg_B.Selector8_p.DistLong; |
| 16953 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objYPos = |
| 16954 | fusionAlg_B.Selector8_p.DistLat; |
| 16955 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objID = |
| 16956 | fusionAlg_B.DataTypeConversion_glw; |
| 16957 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objUpdateFlag = |
| 16958 | fusionAlg_B.Switch_ei; |
| 16959 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objValidFlag = |
| 16960 | fusionAlg_B.Switch_ei; |
| 16961 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objType = |
| 16962 | fusionAlg_P_g.Constant9_Value_aw; |
| 16963 | fusionAlg_B.BusCreator_ad.radarObj.radar_09_obj.objMeasFlag = |
| 16964 | fusionAlg_P_g.Constant10_Value_a4; |
| 16965 | |
| 16966 | /* Selector: '<S139>/Selector9' incorporates: |
| 16967 | * Constant: '<S139>/Constant9' |
| 16968 | */ |
| 16969 | fusionAlg_B.Selector9_jk = rtu_Radar308_Info_st-> |
| 16970 | rightRearRadar_General[fusionAlg_P_g.Constant9_Value_hr]; |
| 16971 | |
| 16972 | /* DataTypeConversion: '<S142>/Data Type Conversion' */ |
| 16973 | tmp = (real32_T)floor(fusionAlg_B.Selector9_jk.ID); |
| 16974 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 16975 | tmp = 0.0F; |
| 16976 | } else { |
| 16977 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 16978 | } |
| 16979 | |
| 16980 | fusionAlg_B.DataTypeConversion_fw = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 16981 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 16982 | |
| 16983 | /* End of DataTypeConversion: '<S142>/Data Type Conversion' */ |
| 16984 | |
| 16985 | /* Switch: '<S142>/Switch' incorporates: |
| 16986 | * Constant: '<S142>/Constant7' |
| 16987 | * Constant: '<S142>/Constant8' |
| 16988 | */ |
| 16989 | if (fusionAlg_B.DataTypeConversion_fw > fusionAlg_P_g.Switch_Threshold_om) { |
| 16990 | fusionAlg_B.Switch_lr = fusionAlg_P_g.Constant7_Value_ed; |
| 16991 | } else { |
| 16992 | fusionAlg_B.Switch_lr = fusionAlg_P_g.Constant8_Value_ki; |
| 16993 | } |
| 16994 | |
| 16995 | /* End of Switch: '<S142>/Switch' */ |
| 16996 | |
| 16997 | /* DataTypeConversion: '<S142>/Data Type Conversion1' */ |
| 16998 | tmp = (real32_T)floor(fusionAlg_B.Selector9_jk.DynProp); |
| 16999 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17000 | tmp = 0.0F; |
| 17001 | } else { |
| 17002 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17003 | } |
| 17004 | |
| 17005 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objMotionPattern = (uint8_T) |
| 17006 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17007 | tmp); |
| 17008 | |
| 17009 | /* End of DataTypeConversion: '<S142>/Data Type Conversion1' */ |
| 17010 | |
| 17011 | /* BusCreator: '<S142>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17012 | * Constant: '<S142>/Constant' |
| 17013 | * Constant: '<S142>/Constant1' |
| 17014 | */ |
| 17015 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.reserved.reserved1 = |
| 17016 | fusionAlg_P_g.Constant_Value_fiu; |
| 17017 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.reserved.reserved0 = |
| 17018 | fusionAlg_P_g.Constant1_Value_kgh; |
| 17019 | |
| 17020 | /* BusCreator: '<S142>/Bus Creator1' incorporates: |
| 17021 | * Constant: '<S142>/Constant10' |
| 17022 | * Constant: '<S142>/Constant2' |
| 17023 | * Constant: '<S142>/Constant3' |
| 17024 | * Constant: '<S142>/Constant4' |
| 17025 | * Constant: '<S142>/Constant5' |
| 17026 | * Constant: '<S142>/Constant6' |
| 17027 | * Constant: '<S142>/Constant9' |
| 17028 | */ |
| 17029 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objObstacleProb = |
| 17030 | fusionAlg_B.Selector9_jk.RCS; |
| 17031 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objXPos_Stdev = |
| 17032 | fusionAlg_P_g.Constant2_Value_aa; |
| 17033 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objYPos_Stdev = |
| 17034 | fusionAlg_P_g.Constant3_Value_hl; |
| 17035 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objXVelRel_Stdev = |
| 17036 | fusionAlg_P_g.Constant4_Value_lpr; |
| 17037 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objXAccRel = |
| 17038 | fusionAlg_P_g.Constant5_Value_o3; |
| 17039 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objExstProb = |
| 17040 | fusionAlg_P_g.Constant6_Value_p3; |
| 17041 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objYVelRel = |
| 17042 | fusionAlg_B.Selector9_jk.VrelLat; |
| 17043 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objXVelRel = |
| 17044 | fusionAlg_B.Selector9_jk.VrelLong; |
| 17045 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objXPos = |
| 17046 | fusionAlg_B.Selector9_jk.DistLong; |
| 17047 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objYPos = |
| 17048 | fusionAlg_B.Selector9_jk.DistLat; |
| 17049 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objID = |
| 17050 | fusionAlg_B.DataTypeConversion_fw; |
| 17051 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objUpdateFlag = |
| 17052 | fusionAlg_B.Switch_lr; |
| 17053 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objValidFlag = |
| 17054 | fusionAlg_B.Switch_lr; |
| 17055 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objType = |
| 17056 | fusionAlg_P_g.Constant9_Value_nr; |
| 17057 | fusionAlg_B.BusCreator_ad.radarObj.radar_10_obj.objMeasFlag = |
| 17058 | fusionAlg_P_g.Constant10_Value_hi; |
| 17059 | |
| 17060 | /* Selector: '<S139>/Selector10' incorporates: |
| 17061 | * Constant: '<S139>/Constant10' |
| 17062 | */ |
| 17063 | fusionAlg_B.Selector10_d1 = rtu_Radar308_Info_st-> |
| 17064 | rightRearRadar_General[fusionAlg_P_g.Constant10_Value_mb]; |
| 17065 | |
| 17066 | /* DataTypeConversion: '<S143>/Data Type Conversion' */ |
| 17067 | tmp = (real32_T)floor(fusionAlg_B.Selector10_d1.ID); |
| 17068 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17069 | tmp = 0.0F; |
| 17070 | } else { |
| 17071 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17072 | } |
| 17073 | |
| 17074 | fusionAlg_B.DataTypeConversion_g5 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 17075 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17076 | |
| 17077 | /* End of DataTypeConversion: '<S143>/Data Type Conversion' */ |
| 17078 | |
| 17079 | /* Switch: '<S143>/Switch' incorporates: |
| 17080 | * Constant: '<S143>/Constant7' |
| 17081 | * Constant: '<S143>/Constant8' |
| 17082 | */ |
| 17083 | if (fusionAlg_B.DataTypeConversion_g5 > fusionAlg_P_g.Switch_Threshold_l2) { |
| 17084 | fusionAlg_B.Switch_bg = fusionAlg_P_g.Constant7_Value_m1; |
| 17085 | } else { |
| 17086 | fusionAlg_B.Switch_bg = fusionAlg_P_g.Constant8_Value_is; |
| 17087 | } |
| 17088 | |
| 17089 | /* End of Switch: '<S143>/Switch' */ |
| 17090 | |
| 17091 | /* DataTypeConversion: '<S143>/Data Type Conversion1' */ |
| 17092 | tmp = (real32_T)floor(fusionAlg_B.Selector10_d1.DynProp); |
| 17093 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17094 | tmp = 0.0F; |
| 17095 | } else { |
| 17096 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17097 | } |
| 17098 | |
| 17099 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objMotionPattern = (uint8_T) |
| 17100 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17101 | tmp); |
| 17102 | |
| 17103 | /* End of DataTypeConversion: '<S143>/Data Type Conversion1' */ |
| 17104 | |
| 17105 | /* BusCreator: '<S143>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17106 | * Constant: '<S143>/Constant' |
| 17107 | * Constant: '<S143>/Constant1' |
| 17108 | */ |
| 17109 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.reserved.reserved1 = |
| 17110 | fusionAlg_P_g.Constant_Value_ls; |
| 17111 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.reserved.reserved0 = |
| 17112 | fusionAlg_P_g.Constant1_Value_c0; |
| 17113 | |
| 17114 | /* BusCreator: '<S143>/Bus Creator1' incorporates: |
| 17115 | * Constant: '<S143>/Constant10' |
| 17116 | * Constant: '<S143>/Constant2' |
| 17117 | * Constant: '<S143>/Constant3' |
| 17118 | * Constant: '<S143>/Constant4' |
| 17119 | * Constant: '<S143>/Constant5' |
| 17120 | * Constant: '<S143>/Constant6' |
| 17121 | * Constant: '<S143>/Constant9' |
| 17122 | */ |
| 17123 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objObstacleProb = |
| 17124 | fusionAlg_B.Selector10_d1.RCS; |
| 17125 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objXPos_Stdev = |
| 17126 | fusionAlg_P_g.Constant2_Value_gy; |
| 17127 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objYPos_Stdev = |
| 17128 | fusionAlg_P_g.Constant3_Value_o3; |
| 17129 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objXVelRel_Stdev = |
| 17130 | fusionAlg_P_g.Constant4_Value_cd; |
| 17131 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objXAccRel = |
| 17132 | fusionAlg_P_g.Constant5_Value_cw; |
| 17133 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objExstProb = |
| 17134 | fusionAlg_P_g.Constant6_Value_c5; |
| 17135 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objYVelRel = |
| 17136 | fusionAlg_B.Selector10_d1.VrelLat; |
| 17137 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objXVelRel = |
| 17138 | fusionAlg_B.Selector10_d1.VrelLong; |
| 17139 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objXPos = |
| 17140 | fusionAlg_B.Selector10_d1.DistLong; |
| 17141 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objYPos = |
| 17142 | fusionAlg_B.Selector10_d1.DistLat; |
| 17143 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objID = |
| 17144 | fusionAlg_B.DataTypeConversion_g5; |
| 17145 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objUpdateFlag = |
| 17146 | fusionAlg_B.Switch_bg; |
| 17147 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objValidFlag = |
| 17148 | fusionAlg_B.Switch_bg; |
| 17149 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objType = |
| 17150 | fusionAlg_P_g.Constant9_Value_kp; |
| 17151 | fusionAlg_B.BusCreator_ad.radarObj.radar_11_obj.objMeasFlag = |
| 17152 | fusionAlg_P_g.Constant10_Value_i2; |
| 17153 | |
| 17154 | /* Selector: '<S139>/Selector11' incorporates: |
| 17155 | * Constant: '<S139>/Constant11' |
| 17156 | */ |
| 17157 | fusionAlg_B.Selector11_m = rtu_Radar308_Info_st-> |
| 17158 | rightRearRadar_General[fusionAlg_P_g.Constant11_Value_a]; |
| 17159 | |
| 17160 | /* DataTypeConversion: '<S144>/Data Type Conversion' */ |
| 17161 | tmp = (real32_T)floor(fusionAlg_B.Selector11_m.ID); |
| 17162 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17163 | tmp = 0.0F; |
| 17164 | } else { |
| 17165 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17166 | } |
| 17167 | |
| 17168 | fusionAlg_B.DataTypeConversion_gw = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 17169 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17170 | |
| 17171 | /* End of DataTypeConversion: '<S144>/Data Type Conversion' */ |
| 17172 | |
| 17173 | /* Switch: '<S144>/Switch' incorporates: |
| 17174 | * Constant: '<S144>/Constant7' |
| 17175 | * Constant: '<S144>/Constant8' |
| 17176 | */ |
| 17177 | if (fusionAlg_B.DataTypeConversion_gw > fusionAlg_P_g.Switch_Threshold_cc) { |
| 17178 | fusionAlg_B.Switch_nf = fusionAlg_P_g.Constant7_Value_fy; |
| 17179 | } else { |
| 17180 | fusionAlg_B.Switch_nf = fusionAlg_P_g.Constant8_Value_lj; |
| 17181 | } |
| 17182 | |
| 17183 | /* End of Switch: '<S144>/Switch' */ |
| 17184 | |
| 17185 | /* DataTypeConversion: '<S144>/Data Type Conversion1' */ |
| 17186 | tmp = (real32_T)floor(fusionAlg_B.Selector11_m.DynProp); |
| 17187 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17188 | tmp = 0.0F; |
| 17189 | } else { |
| 17190 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17191 | } |
| 17192 | |
| 17193 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objMotionPattern = (uint8_T) |
| 17194 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17195 | tmp); |
| 17196 | |
| 17197 | /* End of DataTypeConversion: '<S144>/Data Type Conversion1' */ |
| 17198 | |
| 17199 | /* BusCreator: '<S144>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17200 | * Constant: '<S144>/Constant' |
| 17201 | * Constant: '<S144>/Constant1' |
| 17202 | */ |
| 17203 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.reserved.reserved1 = |
| 17204 | fusionAlg_P_g.Constant_Value_in; |
| 17205 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.reserved.reserved0 = |
| 17206 | fusionAlg_P_g.Constant1_Value_nwq; |
| 17207 | |
| 17208 | /* BusCreator: '<S144>/Bus Creator1' incorporates: |
| 17209 | * Constant: '<S144>/Constant10' |
| 17210 | * Constant: '<S144>/Constant2' |
| 17211 | * Constant: '<S144>/Constant3' |
| 17212 | * Constant: '<S144>/Constant4' |
| 17213 | * Constant: '<S144>/Constant5' |
| 17214 | * Constant: '<S144>/Constant6' |
| 17215 | * Constant: '<S144>/Constant9' |
| 17216 | */ |
| 17217 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objObstacleProb = |
| 17218 | fusionAlg_B.Selector11_m.RCS; |
| 17219 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objXPos_Stdev = |
| 17220 | fusionAlg_P_g.Constant2_Value_jf; |
| 17221 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objYPos_Stdev = |
| 17222 | fusionAlg_P_g.Constant3_Value_ni; |
| 17223 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objXVelRel_Stdev = |
| 17224 | fusionAlg_P_g.Constant4_Value_oc; |
| 17225 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objXAccRel = |
| 17226 | fusionAlg_P_g.Constant5_Value_nz; |
| 17227 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objExstProb = |
| 17228 | fusionAlg_P_g.Constant6_Value_kv; |
| 17229 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objYVelRel = |
| 17230 | fusionAlg_B.Selector11_m.VrelLat; |
| 17231 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objXVelRel = |
| 17232 | fusionAlg_B.Selector11_m.VrelLong; |
| 17233 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objXPos = |
| 17234 | fusionAlg_B.Selector11_m.DistLong; |
| 17235 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objYPos = |
| 17236 | fusionAlg_B.Selector11_m.DistLat; |
| 17237 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objID = |
| 17238 | fusionAlg_B.DataTypeConversion_gw; |
| 17239 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objUpdateFlag = |
| 17240 | fusionAlg_B.Switch_nf; |
| 17241 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objValidFlag = |
| 17242 | fusionAlg_B.Switch_nf; |
| 17243 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objType = |
| 17244 | fusionAlg_P_g.Constant9_Value_lk; |
| 17245 | fusionAlg_B.BusCreator_ad.radarObj.radar_12_obj.objMeasFlag = |
| 17246 | fusionAlg_P_g.Constant10_Value_n5; |
| 17247 | |
| 17248 | /* Selector: '<S139>/Selector12' incorporates: |
| 17249 | * Constant: '<S139>/Constant12' |
| 17250 | */ |
| 17251 | fusionAlg_B.Selector12_j = rtu_Radar308_Info_st-> |
| 17252 | rightRearRadar_General[fusionAlg_P_g.Constant12_Value_d]; |
| 17253 | |
| 17254 | /* DataTypeConversion: '<S145>/Data Type Conversion' */ |
| 17255 | tmp = (real32_T)floor(fusionAlg_B.Selector12_j.ID); |
| 17256 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17257 | tmp = 0.0F; |
| 17258 | } else { |
| 17259 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17260 | } |
| 17261 | |
| 17262 | fusionAlg_B.DataTypeConversion_gs = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 17263 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17264 | |
| 17265 | /* End of DataTypeConversion: '<S145>/Data Type Conversion' */ |
| 17266 | |
| 17267 | /* Switch: '<S145>/Switch' incorporates: |
| 17268 | * Constant: '<S145>/Constant7' |
| 17269 | * Constant: '<S145>/Constant8' |
| 17270 | */ |
| 17271 | if (fusionAlg_B.DataTypeConversion_gs > fusionAlg_P_g.Switch_Threshold_on) { |
| 17272 | fusionAlg_B.Switch_l2 = fusionAlg_P_g.Constant7_Value_cm; |
| 17273 | } else { |
| 17274 | fusionAlg_B.Switch_l2 = fusionAlg_P_g.Constant8_Value_c2; |
| 17275 | } |
| 17276 | |
| 17277 | /* End of Switch: '<S145>/Switch' */ |
| 17278 | |
| 17279 | /* DataTypeConversion: '<S145>/Data Type Conversion1' */ |
| 17280 | tmp = (real32_T)floor(fusionAlg_B.Selector12_j.DynProp); |
| 17281 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17282 | tmp = 0.0F; |
| 17283 | } else { |
| 17284 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17285 | } |
| 17286 | |
| 17287 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objMotionPattern = (uint8_T) |
| 17288 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17289 | tmp); |
| 17290 | |
| 17291 | /* End of DataTypeConversion: '<S145>/Data Type Conversion1' */ |
| 17292 | |
| 17293 | /* BusCreator: '<S145>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17294 | * Constant: '<S145>/Constant' |
| 17295 | * Constant: '<S145>/Constant1' |
| 17296 | */ |
| 17297 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.reserved.reserved1 = |
| 17298 | fusionAlg_P_g.Constant_Value_iq; |
| 17299 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.reserved.reserved0 = |
| 17300 | fusionAlg_P_g.Constant1_Value_jgy; |
| 17301 | |
| 17302 | /* BusCreator: '<S145>/Bus Creator1' incorporates: |
| 17303 | * Constant: '<S145>/Constant10' |
| 17304 | * Constant: '<S145>/Constant2' |
| 17305 | * Constant: '<S145>/Constant3' |
| 17306 | * Constant: '<S145>/Constant4' |
| 17307 | * Constant: '<S145>/Constant5' |
| 17308 | * Constant: '<S145>/Constant6' |
| 17309 | * Constant: '<S145>/Constant9' |
| 17310 | */ |
| 17311 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objObstacleProb = |
| 17312 | fusionAlg_B.Selector12_j.RCS; |
| 17313 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objXPos_Stdev = |
| 17314 | fusionAlg_P_g.Constant2_Value_co; |
| 17315 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objYPos_Stdev = |
| 17316 | fusionAlg_P_g.Constant3_Value_e2; |
| 17317 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objXVelRel_Stdev = |
| 17318 | fusionAlg_P_g.Constant4_Value_ez; |
| 17319 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objXAccRel = |
| 17320 | fusionAlg_P_g.Constant5_Value_h0w; |
| 17321 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objExstProb = |
| 17322 | fusionAlg_P_g.Constant6_Value_oz; |
| 17323 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objYVelRel = |
| 17324 | fusionAlg_B.Selector12_j.VrelLat; |
| 17325 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objXVelRel = |
| 17326 | fusionAlg_B.Selector12_j.VrelLong; |
| 17327 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objXPos = |
| 17328 | fusionAlg_B.Selector12_j.DistLong; |
| 17329 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objYPos = |
| 17330 | fusionAlg_B.Selector12_j.DistLat; |
| 17331 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objID = |
| 17332 | fusionAlg_B.DataTypeConversion_gs; |
| 17333 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objUpdateFlag = |
| 17334 | fusionAlg_B.Switch_l2; |
| 17335 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objValidFlag = |
| 17336 | fusionAlg_B.Switch_l2; |
| 17337 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objType = |
| 17338 | fusionAlg_P_g.Constant9_Value_gr; |
| 17339 | fusionAlg_B.BusCreator_ad.radarObj.radar_13_obj.objMeasFlag = |
| 17340 | fusionAlg_P_g.Constant10_Value_mj; |
| 17341 | |
| 17342 | /* Selector: '<S139>/Selector13' incorporates: |
| 17343 | * Constant: '<S139>/Constant13' |
| 17344 | */ |
| 17345 | fusionAlg_B.Selector13_k = rtu_Radar308_Info_st-> |
| 17346 | rightRearRadar_General[fusionAlg_P_g.Constant13_Value_l]; |
| 17347 | |
| 17348 | /* DataTypeConversion: '<S146>/Data Type Conversion' */ |
| 17349 | tmp = (real32_T)floor(fusionAlg_B.Selector13_k.ID); |
| 17350 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17351 | tmp = 0.0F; |
| 17352 | } else { |
| 17353 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17354 | } |
| 17355 | |
| 17356 | fusionAlg_B.DataTypeConversion_f1r = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 17357 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17358 | |
| 17359 | /* End of DataTypeConversion: '<S146>/Data Type Conversion' */ |
| 17360 | |
| 17361 | /* Switch: '<S146>/Switch' incorporates: |
| 17362 | * Constant: '<S146>/Constant7' |
| 17363 | * Constant: '<S146>/Constant8' |
| 17364 | */ |
| 17365 | if (fusionAlg_B.DataTypeConversion_f1r > fusionAlg_P_g.Switch_Threshold_bh) { |
| 17366 | fusionAlg_B.Switch_ms = fusionAlg_P_g.Constant7_Value_jk; |
| 17367 | } else { |
| 17368 | fusionAlg_B.Switch_ms = fusionAlg_P_g.Constant8_Value_kil; |
| 17369 | } |
| 17370 | |
| 17371 | /* End of Switch: '<S146>/Switch' */ |
| 17372 | |
| 17373 | /* DataTypeConversion: '<S146>/Data Type Conversion1' */ |
| 17374 | tmp = (real32_T)floor(fusionAlg_B.Selector13_k.DynProp); |
| 17375 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17376 | tmp = 0.0F; |
| 17377 | } else { |
| 17378 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17379 | } |
| 17380 | |
| 17381 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objMotionPattern = (uint8_T) |
| 17382 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17383 | tmp); |
| 17384 | |
| 17385 | /* End of DataTypeConversion: '<S146>/Data Type Conversion1' */ |
| 17386 | |
| 17387 | /* BusCreator: '<S146>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17388 | * Constant: '<S146>/Constant' |
| 17389 | * Constant: '<S146>/Constant1' |
| 17390 | */ |
| 17391 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.reserved.reserved1 = |
| 17392 | fusionAlg_P_g.Constant_Value_avj; |
| 17393 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.reserved.reserved0 = |
| 17394 | fusionAlg_P_g.Constant1_Value_fu; |
| 17395 | |
| 17396 | /* BusCreator: '<S146>/Bus Creator1' incorporates: |
| 17397 | * Constant: '<S146>/Constant10' |
| 17398 | * Constant: '<S146>/Constant2' |
| 17399 | * Constant: '<S146>/Constant3' |
| 17400 | * Constant: '<S146>/Constant4' |
| 17401 | * Constant: '<S146>/Constant5' |
| 17402 | * Constant: '<S146>/Constant6' |
| 17403 | * Constant: '<S146>/Constant9' |
| 17404 | */ |
| 17405 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objObstacleProb = |
| 17406 | fusionAlg_B.Selector13_k.RCS; |
| 17407 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objXPos_Stdev = |
| 17408 | fusionAlg_P_g.Constant2_Value_be; |
| 17409 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objYPos_Stdev = |
| 17410 | fusionAlg_P_g.Constant3_Value_frq; |
| 17411 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objXVelRel_Stdev = |
| 17412 | fusionAlg_P_g.Constant4_Value_oo; |
| 17413 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objXAccRel = |
| 17414 | fusionAlg_P_g.Constant5_Value_a2; |
| 17415 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objExstProb = |
| 17416 | fusionAlg_P_g.Constant6_Value_ic; |
| 17417 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objYVelRel = |
| 17418 | fusionAlg_B.Selector13_k.VrelLat; |
| 17419 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objXVelRel = |
| 17420 | fusionAlg_B.Selector13_k.VrelLong; |
| 17421 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objXPos = |
| 17422 | fusionAlg_B.Selector13_k.DistLong; |
| 17423 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objYPos = |
| 17424 | fusionAlg_B.Selector13_k.DistLat; |
| 17425 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objID = |
| 17426 | fusionAlg_B.DataTypeConversion_f1r; |
| 17427 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objUpdateFlag = |
| 17428 | fusionAlg_B.Switch_ms; |
| 17429 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objValidFlag = |
| 17430 | fusionAlg_B.Switch_ms; |
| 17431 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objType = |
| 17432 | fusionAlg_P_g.Constant9_Value_mv; |
| 17433 | fusionAlg_B.BusCreator_ad.radarObj.radar_14_obj.objMeasFlag = |
| 17434 | fusionAlg_P_g.Constant10_Value_dd; |
| 17435 | |
| 17436 | /* Selector: '<S139>/Selector14' incorporates: |
| 17437 | * Constant: '<S139>/Constant14' |
| 17438 | */ |
| 17439 | fusionAlg_B.Selector14_h = rtu_Radar308_Info_st-> |
| 17440 | rightRearRadar_General[fusionAlg_P_g.Constant14_Value_g]; |
| 17441 | |
| 17442 | /* DataTypeConversion: '<S147>/Data Type Conversion' */ |
| 17443 | tmp = (real32_T)floor(fusionAlg_B.Selector14_h.ID); |
| 17444 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17445 | tmp = 0.0F; |
| 17446 | } else { |
| 17447 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17448 | } |
| 17449 | |
| 17450 | fusionAlg_B.DataTypeConversion_pe = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 17451 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17452 | |
| 17453 | /* End of DataTypeConversion: '<S147>/Data Type Conversion' */ |
| 17454 | |
| 17455 | /* Switch: '<S147>/Switch' incorporates: |
| 17456 | * Constant: '<S147>/Constant7' |
| 17457 | * Constant: '<S147>/Constant8' |
| 17458 | */ |
| 17459 | if (fusionAlg_B.DataTypeConversion_pe > fusionAlg_P_g.Switch_Threshold_llc) { |
| 17460 | fusionAlg_B.Switch_oh = fusionAlg_P_g.Constant7_Value_a0; |
| 17461 | } else { |
| 17462 | fusionAlg_B.Switch_oh = fusionAlg_P_g.Constant8_Value_lw4; |
| 17463 | } |
| 17464 | |
| 17465 | /* End of Switch: '<S147>/Switch' */ |
| 17466 | |
| 17467 | /* DataTypeConversion: '<S147>/Data Type Conversion1' */ |
| 17468 | tmp = (real32_T)floor(fusionAlg_B.Selector14_h.DynProp); |
| 17469 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17470 | tmp = 0.0F; |
| 17471 | } else { |
| 17472 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17473 | } |
| 17474 | |
| 17475 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objMotionPattern = (uint8_T) |
| 17476 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17477 | tmp); |
| 17478 | |
| 17479 | /* End of DataTypeConversion: '<S147>/Data Type Conversion1' */ |
| 17480 | |
| 17481 | /* BusCreator: '<S147>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17482 | * Constant: '<S147>/Constant' |
| 17483 | * Constant: '<S147>/Constant1' |
| 17484 | */ |
| 17485 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.reserved.reserved1 = |
| 17486 | fusionAlg_P_g.Constant_Value_exd; |
| 17487 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.reserved.reserved0 = |
| 17488 | fusionAlg_P_g.Constant1_Value_nj; |
| 17489 | |
| 17490 | /* BusCreator: '<S147>/Bus Creator1' incorporates: |
| 17491 | * Constant: '<S147>/Constant10' |
| 17492 | * Constant: '<S147>/Constant2' |
| 17493 | * Constant: '<S147>/Constant3' |
| 17494 | * Constant: '<S147>/Constant4' |
| 17495 | * Constant: '<S147>/Constant5' |
| 17496 | * Constant: '<S147>/Constant6' |
| 17497 | * Constant: '<S147>/Constant9' |
| 17498 | */ |
| 17499 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objObstacleProb = |
| 17500 | fusionAlg_B.Selector14_h.RCS; |
| 17501 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objXPos_Stdev = |
| 17502 | fusionAlg_P_g.Constant2_Value_egs; |
| 17503 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objYPos_Stdev = |
| 17504 | fusionAlg_P_g.Constant3_Value_b2; |
| 17505 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objXVelRel_Stdev = |
| 17506 | fusionAlg_P_g.Constant4_Value_p2; |
| 17507 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objXAccRel = |
| 17508 | fusionAlg_P_g.Constant5_Value_eb4; |
| 17509 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objExstProb = |
| 17510 | fusionAlg_P_g.Constant6_Value_a1; |
| 17511 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objYVelRel = |
| 17512 | fusionAlg_B.Selector14_h.VrelLat; |
| 17513 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objXVelRel = |
| 17514 | fusionAlg_B.Selector14_h.VrelLong; |
| 17515 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objXPos = |
| 17516 | fusionAlg_B.Selector14_h.DistLong; |
| 17517 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objYPos = |
| 17518 | fusionAlg_B.Selector14_h.DistLat; |
| 17519 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objID = |
| 17520 | fusionAlg_B.DataTypeConversion_pe; |
| 17521 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objUpdateFlag = |
| 17522 | fusionAlg_B.Switch_oh; |
| 17523 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objValidFlag = |
| 17524 | fusionAlg_B.Switch_oh; |
| 17525 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objType = |
| 17526 | fusionAlg_P_g.Constant9_Value_db; |
| 17527 | fusionAlg_B.BusCreator_ad.radarObj.radar_15_obj.objMeasFlag = |
| 17528 | fusionAlg_P_g.Constant10_Value_ep; |
| 17529 | |
| 17530 | /* Selector: '<S139>/Selector15' incorporates: |
| 17531 | * Constant: '<S139>/Constant15' |
| 17532 | */ |
| 17533 | fusionAlg_B.Selector15_b = rtu_Radar308_Info_st-> |
| 17534 | rightRearRadar_General[fusionAlg_P_g.Constant15_Value_p]; |
| 17535 | |
| 17536 | /* DataTypeConversion: '<S148>/Data Type Conversion' */ |
| 17537 | tmp = (real32_T)floor(fusionAlg_B.Selector15_b.ID); |
| 17538 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17539 | tmp = 0.0F; |
| 17540 | } else { |
| 17541 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17542 | } |
| 17543 | |
| 17544 | fusionAlg_B.DataTypeConversion_og = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 17545 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17546 | |
| 17547 | /* End of DataTypeConversion: '<S148>/Data Type Conversion' */ |
| 17548 | |
| 17549 | /* Switch: '<S148>/Switch' incorporates: |
| 17550 | * Constant: '<S148>/Constant7' |
| 17551 | * Constant: '<S148>/Constant8' |
| 17552 | */ |
| 17553 | if (fusionAlg_B.DataTypeConversion_og > fusionAlg_P_g.Switch_Threshold_bt) { |
| 17554 | fusionAlg_B.Switch_j3 = fusionAlg_P_g.Constant7_Value_mp; |
| 17555 | } else { |
| 17556 | fusionAlg_B.Switch_j3 = fusionAlg_P_g.Constant8_Value_oy; |
| 17557 | } |
| 17558 | |
| 17559 | /* End of Switch: '<S148>/Switch' */ |
| 17560 | |
| 17561 | /* DataTypeConversion: '<S148>/Data Type Conversion1' */ |
| 17562 | tmp = (real32_T)floor(fusionAlg_B.Selector15_b.DynProp); |
| 17563 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17564 | tmp = 0.0F; |
| 17565 | } else { |
| 17566 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17567 | } |
| 17568 | |
| 17569 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objMotionPattern = (uint8_T) |
| 17570 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17571 | tmp); |
| 17572 | |
| 17573 | /* End of DataTypeConversion: '<S148>/Data Type Conversion1' */ |
| 17574 | |
| 17575 | /* BusCreator: '<S148>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17576 | * Constant: '<S148>/Constant' |
| 17577 | * Constant: '<S148>/Constant1' |
| 17578 | */ |
| 17579 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.reserved.reserved1 = |
| 17580 | fusionAlg_P_g.Constant_Value_f4; |
| 17581 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.reserved.reserved0 = |
| 17582 | fusionAlg_P_g.Constant1_Value_kdf; |
| 17583 | |
| 17584 | /* BusCreator: '<S148>/Bus Creator1' incorporates: |
| 17585 | * Constant: '<S148>/Constant10' |
| 17586 | * Constant: '<S148>/Constant2' |
| 17587 | * Constant: '<S148>/Constant3' |
| 17588 | * Constant: '<S148>/Constant4' |
| 17589 | * Constant: '<S148>/Constant5' |
| 17590 | * Constant: '<S148>/Constant6' |
| 17591 | * Constant: '<S148>/Constant9' |
| 17592 | */ |
| 17593 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objObstacleProb = |
| 17594 | fusionAlg_B.Selector15_b.RCS; |
| 17595 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objXPos_Stdev = |
| 17596 | fusionAlg_P_g.Constant2_Value_g2; |
| 17597 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objYPos_Stdev = |
| 17598 | fusionAlg_P_g.Constant3_Value_oth; |
| 17599 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objXVelRel_Stdev = |
| 17600 | fusionAlg_P_g.Constant4_Value_kv; |
| 17601 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objXAccRel = |
| 17602 | fusionAlg_P_g.Constant5_Value_evl; |
| 17603 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objExstProb = |
| 17604 | fusionAlg_P_g.Constant6_Value_je; |
| 17605 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objYVelRel = |
| 17606 | fusionAlg_B.Selector15_b.VrelLat; |
| 17607 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objXVelRel = |
| 17608 | fusionAlg_B.Selector15_b.VrelLong; |
| 17609 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objXPos = |
| 17610 | fusionAlg_B.Selector15_b.DistLong; |
| 17611 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objYPos = |
| 17612 | fusionAlg_B.Selector15_b.DistLat; |
| 17613 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objID = |
| 17614 | fusionAlg_B.DataTypeConversion_og; |
| 17615 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objUpdateFlag = |
| 17616 | fusionAlg_B.Switch_j3; |
| 17617 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objValidFlag = |
| 17618 | fusionAlg_B.Switch_j3; |
| 17619 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objType = |
| 17620 | fusionAlg_P_g.Constant9_Value_lo; |
| 17621 | fusionAlg_B.BusCreator_ad.radarObj.radar_16_obj.objMeasFlag = |
| 17622 | fusionAlg_P_g.Constant10_Value_op; |
| 17623 | |
| 17624 | /* Selector: '<S139>/Selector16' incorporates: |
| 17625 | * Constant: '<S139>/Constant16' |
| 17626 | */ |
| 17627 | fusionAlg_B.Selector16_g = rtu_Radar308_Info_st-> |
| 17628 | rightRearRadar_General[fusionAlg_P_g.Constant16_Value_g]; |
| 17629 | |
| 17630 | /* DataTypeConversion: '<S149>/Data Type Conversion' */ |
| 17631 | tmp = (real32_T)floor(fusionAlg_B.Selector16_g.ID); |
| 17632 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17633 | tmp = 0.0F; |
| 17634 | } else { |
| 17635 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17636 | } |
| 17637 | |
| 17638 | fusionAlg_B.DataTypeConversion_efw = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 17639 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17640 | |
| 17641 | /* End of DataTypeConversion: '<S149>/Data Type Conversion' */ |
| 17642 | |
| 17643 | /* Switch: '<S149>/Switch' incorporates: |
| 17644 | * Constant: '<S149>/Constant7' |
| 17645 | * Constant: '<S149>/Constant8' |
| 17646 | */ |
| 17647 | if (fusionAlg_B.DataTypeConversion_efw > fusionAlg_P_g.Switch_Threshold_bk) { |
| 17648 | fusionAlg_B.Switch_l5 = fusionAlg_P_g.Constant7_Value_bp; |
| 17649 | } else { |
| 17650 | fusionAlg_B.Switch_l5 = fusionAlg_P_g.Constant8_Value_ix; |
| 17651 | } |
| 17652 | |
| 17653 | /* End of Switch: '<S149>/Switch' */ |
| 17654 | |
| 17655 | /* DataTypeConversion: '<S149>/Data Type Conversion1' */ |
| 17656 | tmp = (real32_T)floor(fusionAlg_B.Selector16_g.DynProp); |
| 17657 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17658 | tmp = 0.0F; |
| 17659 | } else { |
| 17660 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17661 | } |
| 17662 | |
| 17663 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objMotionPattern = (uint8_T) |
| 17664 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17665 | tmp); |
| 17666 | |
| 17667 | /* End of DataTypeConversion: '<S149>/Data Type Conversion1' */ |
| 17668 | |
| 17669 | /* BusCreator: '<S149>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17670 | * Constant: '<S149>/Constant' |
| 17671 | * Constant: '<S149>/Constant1' |
| 17672 | */ |
| 17673 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.reserved.reserved1 = |
| 17674 | fusionAlg_P_g.Constant_Value_jqh; |
| 17675 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.reserved.reserved0 = |
| 17676 | fusionAlg_P_g.Constant1_Value_oiv; |
| 17677 | |
| 17678 | /* BusCreator: '<S149>/Bus Creator1' incorporates: |
| 17679 | * Constant: '<S149>/Constant10' |
| 17680 | * Constant: '<S149>/Constant2' |
| 17681 | * Constant: '<S149>/Constant3' |
| 17682 | * Constant: '<S149>/Constant4' |
| 17683 | * Constant: '<S149>/Constant5' |
| 17684 | * Constant: '<S149>/Constant6' |
| 17685 | * Constant: '<S149>/Constant9' |
| 17686 | */ |
| 17687 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objObstacleProb = |
| 17688 | fusionAlg_B.Selector16_g.RCS; |
| 17689 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objXPos_Stdev = |
| 17690 | fusionAlg_P_g.Constant2_Value_gsf; |
| 17691 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objYPos_Stdev = |
| 17692 | fusionAlg_P_g.Constant3_Value_cv; |
| 17693 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objXVelRel_Stdev = |
| 17694 | fusionAlg_P_g.Constant4_Value_fo; |
| 17695 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objXAccRel = |
| 17696 | fusionAlg_P_g.Constant5_Value_j5; |
| 17697 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objExstProb = |
| 17698 | fusionAlg_P_g.Constant6_Value_c2; |
| 17699 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objYVelRel = |
| 17700 | fusionAlg_B.Selector16_g.VrelLat; |
| 17701 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objXVelRel = |
| 17702 | fusionAlg_B.Selector16_g.VrelLong; |
| 17703 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objXPos = |
| 17704 | fusionAlg_B.Selector16_g.DistLong; |
| 17705 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objYPos = |
| 17706 | fusionAlg_B.Selector16_g.DistLat; |
| 17707 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objID = |
| 17708 | fusionAlg_B.DataTypeConversion_efw; |
| 17709 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objUpdateFlag = |
| 17710 | fusionAlg_B.Switch_l5; |
| 17711 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objValidFlag = |
| 17712 | fusionAlg_B.Switch_l5; |
| 17713 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objType = |
| 17714 | fusionAlg_P_g.Constant9_Value_lj; |
| 17715 | fusionAlg_B.BusCreator_ad.radarObj.radar_17_obj.objMeasFlag = |
| 17716 | fusionAlg_P_g.Constant10_Value_hmo; |
| 17717 | |
| 17718 | /* Selector: '<S139>/Selector24' incorporates: |
| 17719 | * Constant: '<S139>/Constant17' |
| 17720 | */ |
| 17721 | fusionAlg_B.Selector24_i = rtu_Radar308_Info_st-> |
| 17722 | rightRearRadar_General[fusionAlg_P_g.Constant17_Value_j]; |
| 17723 | |
| 17724 | /* DataTypeConversion: '<S150>/Data Type Conversion' */ |
| 17725 | tmp = (real32_T)floor(fusionAlg_B.Selector24_i.ID); |
| 17726 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17727 | tmp = 0.0F; |
| 17728 | } else { |
| 17729 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17730 | } |
| 17731 | |
| 17732 | fusionAlg_B.DataTypeConversion_h0 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 17733 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17734 | |
| 17735 | /* End of DataTypeConversion: '<S150>/Data Type Conversion' */ |
| 17736 | |
| 17737 | /* Switch: '<S150>/Switch' incorporates: |
| 17738 | * Constant: '<S150>/Constant7' |
| 17739 | * Constant: '<S150>/Constant8' |
| 17740 | */ |
| 17741 | if (fusionAlg_B.DataTypeConversion_h0 > fusionAlg_P_g.Switch_Threshold_n5x) { |
| 17742 | fusionAlg_B.Switch_lj = fusionAlg_P_g.Constant7_Value_ph; |
| 17743 | } else { |
| 17744 | fusionAlg_B.Switch_lj = fusionAlg_P_g.Constant8_Value_mc; |
| 17745 | } |
| 17746 | |
| 17747 | /* End of Switch: '<S150>/Switch' */ |
| 17748 | |
| 17749 | /* DataTypeConversion: '<S150>/Data Type Conversion1' */ |
| 17750 | tmp = (real32_T)floor(fusionAlg_B.Selector24_i.DynProp); |
| 17751 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17752 | tmp = 0.0F; |
| 17753 | } else { |
| 17754 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17755 | } |
| 17756 | |
| 17757 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objMotionPattern = (uint8_T) |
| 17758 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17759 | tmp); |
| 17760 | |
| 17761 | /* End of DataTypeConversion: '<S150>/Data Type Conversion1' */ |
| 17762 | |
| 17763 | /* BusCreator: '<S150>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17764 | * Constant: '<S150>/Constant' |
| 17765 | * Constant: '<S150>/Constant1' |
| 17766 | */ |
| 17767 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.reserved.reserved1 = |
| 17768 | fusionAlg_P_g.Constant_Value_lp; |
| 17769 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.reserved.reserved0 = |
| 17770 | fusionAlg_P_g.Constant1_Value_o0; |
| 17771 | |
| 17772 | /* BusCreator: '<S150>/Bus Creator1' incorporates: |
| 17773 | * Constant: '<S150>/Constant10' |
| 17774 | * Constant: '<S150>/Constant2' |
| 17775 | * Constant: '<S150>/Constant3' |
| 17776 | * Constant: '<S150>/Constant4' |
| 17777 | * Constant: '<S150>/Constant5' |
| 17778 | * Constant: '<S150>/Constant6' |
| 17779 | * Constant: '<S150>/Constant9' |
| 17780 | */ |
| 17781 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objObstacleProb = |
| 17782 | fusionAlg_B.Selector24_i.RCS; |
| 17783 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objXPos_Stdev = |
| 17784 | fusionAlg_P_g.Constant2_Value_fd; |
| 17785 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objYPos_Stdev = |
| 17786 | fusionAlg_P_g.Constant3_Value_gs; |
| 17787 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objXVelRel_Stdev = |
| 17788 | fusionAlg_P_g.Constant4_Value_dv; |
| 17789 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objXAccRel = |
| 17790 | fusionAlg_P_g.Constant5_Value_fs; |
| 17791 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objExstProb = |
| 17792 | fusionAlg_P_g.Constant6_Value_b0; |
| 17793 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objYVelRel = |
| 17794 | fusionAlg_B.Selector24_i.VrelLat; |
| 17795 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objXVelRel = |
| 17796 | fusionAlg_B.Selector24_i.VrelLong; |
| 17797 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objXPos = |
| 17798 | fusionAlg_B.Selector24_i.DistLong; |
| 17799 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objYPos = |
| 17800 | fusionAlg_B.Selector24_i.DistLat; |
| 17801 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objID = |
| 17802 | fusionAlg_B.DataTypeConversion_h0; |
| 17803 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objUpdateFlag = |
| 17804 | fusionAlg_B.Switch_lj; |
| 17805 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objValidFlag = |
| 17806 | fusionAlg_B.Switch_lj; |
| 17807 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objType = |
| 17808 | fusionAlg_P_g.Constant9_Value_lad; |
| 17809 | fusionAlg_B.BusCreator_ad.radarObj.radar_18_obj.objMeasFlag = |
| 17810 | fusionAlg_P_g.Constant10_Value_es; |
| 17811 | |
| 17812 | /* Selector: '<S139>/Selector25' incorporates: |
| 17813 | * Constant: '<S139>/Constant18' |
| 17814 | */ |
| 17815 | fusionAlg_B.Selector25_m = rtu_Radar308_Info_st-> |
| 17816 | rightRearRadar_General[fusionAlg_P_g.Constant18_Value_g]; |
| 17817 | |
| 17818 | /* DataTypeConversion: '<S151>/Data Type Conversion' */ |
| 17819 | tmp = (real32_T)floor(fusionAlg_B.Selector25_m.ID); |
| 17820 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17821 | tmp = 0.0F; |
| 17822 | } else { |
| 17823 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17824 | } |
| 17825 | |
| 17826 | fusionAlg_B.DataTypeConversion_ls = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 17827 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17828 | |
| 17829 | /* End of DataTypeConversion: '<S151>/Data Type Conversion' */ |
| 17830 | |
| 17831 | /* Switch: '<S151>/Switch' incorporates: |
| 17832 | * Constant: '<S151>/Constant7' |
| 17833 | * Constant: '<S151>/Constant8' |
| 17834 | */ |
| 17835 | if (fusionAlg_B.DataTypeConversion_ls > fusionAlg_P_g.Switch_Threshold_he) { |
| 17836 | fusionAlg_B.Switch_gu = fusionAlg_P_g.Constant7_Value_cc; |
| 17837 | } else { |
| 17838 | fusionAlg_B.Switch_gu = fusionAlg_P_g.Constant8_Value_ncv; |
| 17839 | } |
| 17840 | |
| 17841 | /* End of Switch: '<S151>/Switch' */ |
| 17842 | |
| 17843 | /* DataTypeConversion: '<S151>/Data Type Conversion1' */ |
| 17844 | tmp = (real32_T)floor(fusionAlg_B.Selector25_m.DynProp); |
| 17845 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17846 | tmp = 0.0F; |
| 17847 | } else { |
| 17848 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17849 | } |
| 17850 | |
| 17851 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objMotionPattern = (uint8_T) |
| 17852 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17853 | tmp); |
| 17854 | |
| 17855 | /* End of DataTypeConversion: '<S151>/Data Type Conversion1' */ |
| 17856 | |
| 17857 | /* BusCreator: '<S151>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17858 | * Constant: '<S151>/Constant' |
| 17859 | * Constant: '<S151>/Constant1' |
| 17860 | */ |
| 17861 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.reserved.reserved1 = |
| 17862 | fusionAlg_P_g.Constant_Value_jo; |
| 17863 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.reserved.reserved0 = |
| 17864 | fusionAlg_P_g.Constant1_Value_o0v; |
| 17865 | |
| 17866 | /* BusCreator: '<S151>/Bus Creator1' incorporates: |
| 17867 | * Constant: '<S151>/Constant10' |
| 17868 | * Constant: '<S151>/Constant2' |
| 17869 | * Constant: '<S151>/Constant3' |
| 17870 | * Constant: '<S151>/Constant4' |
| 17871 | * Constant: '<S151>/Constant5' |
| 17872 | * Constant: '<S151>/Constant6' |
| 17873 | * Constant: '<S151>/Constant9' |
| 17874 | */ |
| 17875 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objObstacleProb = |
| 17876 | fusionAlg_B.Selector25_m.RCS; |
| 17877 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objXPos_Stdev = |
| 17878 | fusionAlg_P_g.Constant2_Value_px; |
| 17879 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objYPos_Stdev = |
| 17880 | fusionAlg_P_g.Constant3_Value_n4; |
| 17881 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objXVelRel_Stdev = |
| 17882 | fusionAlg_P_g.Constant4_Value_dj; |
| 17883 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objXAccRel = |
| 17884 | fusionAlg_P_g.Constant5_Value_fx; |
| 17885 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objExstProb = |
| 17886 | fusionAlg_P_g.Constant6_Value_p5; |
| 17887 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objYVelRel = |
| 17888 | fusionAlg_B.Selector25_m.VrelLat; |
| 17889 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objXVelRel = |
| 17890 | fusionAlg_B.Selector25_m.VrelLong; |
| 17891 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objXPos = |
| 17892 | fusionAlg_B.Selector25_m.DistLong; |
| 17893 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objYPos = |
| 17894 | fusionAlg_B.Selector25_m.DistLat; |
| 17895 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objID = |
| 17896 | fusionAlg_B.DataTypeConversion_ls; |
| 17897 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objUpdateFlag = |
| 17898 | fusionAlg_B.Switch_gu; |
| 17899 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objValidFlag = |
| 17900 | fusionAlg_B.Switch_gu; |
| 17901 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objType = |
| 17902 | fusionAlg_P_g.Constant9_Value_icv; |
| 17903 | fusionAlg_B.BusCreator_ad.radarObj.radar_19_obj.objMeasFlag = |
| 17904 | fusionAlg_P_g.Constant10_Value_jh; |
| 17905 | |
| 17906 | /* Selector: '<S139>/Selector26' incorporates: |
| 17907 | * Constant: '<S139>/Constant19' |
| 17908 | */ |
| 17909 | fusionAlg_B.Selector26_m = rtu_Radar308_Info_st-> |
| 17910 | rightRearRadar_General[fusionAlg_P_g.Constant19_Value_o]; |
| 17911 | |
| 17912 | /* DataTypeConversion: '<S153>/Data Type Conversion' */ |
| 17913 | tmp = (real32_T)floor(fusionAlg_B.Selector26_m.ID); |
| 17914 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17915 | tmp = 0.0F; |
| 17916 | } else { |
| 17917 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 17918 | } |
| 17919 | |
| 17920 | fusionAlg_B.DataTypeConversion_mke = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 17921 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 17922 | |
| 17923 | /* End of DataTypeConversion: '<S153>/Data Type Conversion' */ |
| 17924 | |
| 17925 | /* Switch: '<S153>/Switch' incorporates: |
| 17926 | * Constant: '<S153>/Constant7' |
| 17927 | * Constant: '<S153>/Constant8' |
| 17928 | */ |
| 17929 | if (fusionAlg_B.DataTypeConversion_mke > fusionAlg_P_g.Switch_Threshold_pn) { |
| 17930 | fusionAlg_B.Switch_ka = fusionAlg_P_g.Constant7_Value_mh; |
| 17931 | } else { |
| 17932 | fusionAlg_B.Switch_ka = fusionAlg_P_g.Constant8_Value_fmg; |
| 17933 | } |
| 17934 | |
| 17935 | /* End of Switch: '<S153>/Switch' */ |
| 17936 | |
| 17937 | /* DataTypeConversion: '<S153>/Data Type Conversion1' */ |
| 17938 | tmp = (real32_T)floor(fusionAlg_B.Selector26_m.DynProp); |
| 17939 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 17940 | tmp = 0.0F; |
| 17941 | } else { |
| 17942 | tmp = (real32_T)fmod(tmp, 256.0); |
| 17943 | } |
| 17944 | |
| 17945 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objMotionPattern = (uint8_T) |
| 17946 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 17947 | tmp); |
| 17948 | |
| 17949 | /* End of DataTypeConversion: '<S153>/Data Type Conversion1' */ |
| 17950 | |
| 17951 | /* BusCreator: '<S153>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 17952 | * Constant: '<S153>/Constant' |
| 17953 | * Constant: '<S153>/Constant1' |
| 17954 | */ |
| 17955 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.reserved.reserved1 = |
| 17956 | fusionAlg_P_g.Constant_Value_bsl; |
| 17957 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.reserved.reserved0 = |
| 17958 | fusionAlg_P_g.Constant1_Value_fyp; |
| 17959 | |
| 17960 | /* BusCreator: '<S153>/Bus Creator1' incorporates: |
| 17961 | * Constant: '<S153>/Constant10' |
| 17962 | * Constant: '<S153>/Constant2' |
| 17963 | * Constant: '<S153>/Constant3' |
| 17964 | * Constant: '<S153>/Constant4' |
| 17965 | * Constant: '<S153>/Constant5' |
| 17966 | * Constant: '<S153>/Constant6' |
| 17967 | * Constant: '<S153>/Constant9' |
| 17968 | */ |
| 17969 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objObstacleProb = |
| 17970 | fusionAlg_B.Selector26_m.RCS; |
| 17971 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objXPos_Stdev = |
| 17972 | fusionAlg_P_g.Constant2_Value_dvr; |
| 17973 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objYPos_Stdev = |
| 17974 | fusionAlg_P_g.Constant3_Value_cdw; |
| 17975 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objXVelRel_Stdev = |
| 17976 | fusionAlg_P_g.Constant4_Value_km; |
| 17977 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objXAccRel = |
| 17978 | fusionAlg_P_g.Constant5_Value_fsv; |
| 17979 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objExstProb = |
| 17980 | fusionAlg_P_g.Constant6_Value_ad; |
| 17981 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objYVelRel = |
| 17982 | fusionAlg_B.Selector26_m.VrelLat; |
| 17983 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objXVelRel = |
| 17984 | fusionAlg_B.Selector26_m.VrelLong; |
| 17985 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objXPos = |
| 17986 | fusionAlg_B.Selector26_m.DistLong; |
| 17987 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objYPos = |
| 17988 | fusionAlg_B.Selector26_m.DistLat; |
| 17989 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objID = |
| 17990 | fusionAlg_B.DataTypeConversion_mke; |
| 17991 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objUpdateFlag = |
| 17992 | fusionAlg_B.Switch_ka; |
| 17993 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objValidFlag = |
| 17994 | fusionAlg_B.Switch_ka; |
| 17995 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objType = |
| 17996 | fusionAlg_P_g.Constant9_Value_jt; |
| 17997 | fusionAlg_B.BusCreator_ad.radarObj.radar_20_obj.objMeasFlag = |
| 17998 | fusionAlg_P_g.Constant10_Value_ay; |
| 17999 | |
| 18000 | /* Selector: '<S139>/Selector27' incorporates: |
| 18001 | * Constant: '<S139>/Constant20' |
| 18002 | */ |
| 18003 | fusionAlg_B.Selector27_d = rtu_Radar308_Info_st-> |
| 18004 | rightRearRadar_General[fusionAlg_P_g.Constant20_Value_f]; |
| 18005 | |
| 18006 | /* DataTypeConversion: '<S154>/Data Type Conversion' */ |
| 18007 | tmp = (real32_T)floor(fusionAlg_B.Selector27_d.ID); |
| 18008 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18009 | tmp = 0.0F; |
| 18010 | } else { |
| 18011 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18012 | } |
| 18013 | |
| 18014 | fusionAlg_B.DataTypeConversion_nzh = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 18015 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18016 | |
| 18017 | /* End of DataTypeConversion: '<S154>/Data Type Conversion' */ |
| 18018 | |
| 18019 | /* Switch: '<S154>/Switch' incorporates: |
| 18020 | * Constant: '<S154>/Constant7' |
| 18021 | * Constant: '<S154>/Constant8' |
| 18022 | */ |
| 18023 | if (fusionAlg_B.DataTypeConversion_nzh > fusionAlg_P_g.Switch_Threshold_ow5) { |
| 18024 | fusionAlg_B.Switch_ho = fusionAlg_P_g.Constant7_Value_p1; |
| 18025 | } else { |
| 18026 | fusionAlg_B.Switch_ho = fusionAlg_P_g.Constant8_Value_bmm; |
| 18027 | } |
| 18028 | |
| 18029 | /* End of Switch: '<S154>/Switch' */ |
| 18030 | |
| 18031 | /* DataTypeConversion: '<S154>/Data Type Conversion1' */ |
| 18032 | tmp = (real32_T)floor(fusionAlg_B.Selector27_d.DynProp); |
| 18033 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18034 | tmp = 0.0F; |
| 18035 | } else { |
| 18036 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18037 | } |
| 18038 | |
| 18039 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objMotionPattern = (uint8_T) |
| 18040 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18041 | tmp); |
| 18042 | |
| 18043 | /* End of DataTypeConversion: '<S154>/Data Type Conversion1' */ |
| 18044 | |
| 18045 | /* BusCreator: '<S154>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18046 | * Constant: '<S154>/Constant' |
| 18047 | * Constant: '<S154>/Constant1' |
| 18048 | */ |
| 18049 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.reserved.reserved1 = |
| 18050 | fusionAlg_P_g.Constant_Value_dry; |
| 18051 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.reserved.reserved0 = |
| 18052 | fusionAlg_P_g.Constant1_Value_eh; |
| 18053 | |
| 18054 | /* BusCreator: '<S154>/Bus Creator1' incorporates: |
| 18055 | * Constant: '<S154>/Constant10' |
| 18056 | * Constant: '<S154>/Constant2' |
| 18057 | * Constant: '<S154>/Constant3' |
| 18058 | * Constant: '<S154>/Constant4' |
| 18059 | * Constant: '<S154>/Constant5' |
| 18060 | * Constant: '<S154>/Constant6' |
| 18061 | * Constant: '<S154>/Constant9' |
| 18062 | */ |
| 18063 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objObstacleProb = |
| 18064 | fusionAlg_B.Selector27_d.RCS; |
| 18065 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objXPos_Stdev = |
| 18066 | fusionAlg_P_g.Constant2_Value_aqs; |
| 18067 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objYPos_Stdev = |
| 18068 | fusionAlg_P_g.Constant3_Value_n2; |
| 18069 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objXVelRel_Stdev = |
| 18070 | fusionAlg_P_g.Constant4_Value_bji; |
| 18071 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objXAccRel = |
| 18072 | fusionAlg_P_g.Constant5_Value_gh; |
| 18073 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objExstProb = |
| 18074 | fusionAlg_P_g.Constant6_Value_gzu; |
| 18075 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objYVelRel = |
| 18076 | fusionAlg_B.Selector27_d.VrelLat; |
| 18077 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objXVelRel = |
| 18078 | fusionAlg_B.Selector27_d.VrelLong; |
| 18079 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objXPos = |
| 18080 | fusionAlg_B.Selector27_d.DistLong; |
| 18081 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objYPos = |
| 18082 | fusionAlg_B.Selector27_d.DistLat; |
| 18083 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objID = |
| 18084 | fusionAlg_B.DataTypeConversion_nzh; |
| 18085 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objUpdateFlag = |
| 18086 | fusionAlg_B.Switch_ho; |
| 18087 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objValidFlag = |
| 18088 | fusionAlg_B.Switch_ho; |
| 18089 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objType = |
| 18090 | fusionAlg_P_g.Constant9_Value_f1; |
| 18091 | fusionAlg_B.BusCreator_ad.radarObj.radar_21_obj.objMeasFlag = |
| 18092 | fusionAlg_P_g.Constant10_Value_ju; |
| 18093 | |
| 18094 | /* Selector: '<S139>/Selector28' incorporates: |
| 18095 | * Constant: '<S139>/Constant21' |
| 18096 | */ |
| 18097 | fusionAlg_B.Selector28_g = rtu_Radar308_Info_st-> |
| 18098 | rightRearRadar_General[fusionAlg_P_g.Constant21_Value_h]; |
| 18099 | |
| 18100 | /* DataTypeConversion: '<S155>/Data Type Conversion' */ |
| 18101 | tmp = (real32_T)floor(fusionAlg_B.Selector28_g.ID); |
| 18102 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18103 | tmp = 0.0F; |
| 18104 | } else { |
| 18105 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18106 | } |
| 18107 | |
| 18108 | fusionAlg_B.DataTypeConversion_h5j = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 18109 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18110 | |
| 18111 | /* End of DataTypeConversion: '<S155>/Data Type Conversion' */ |
| 18112 | |
| 18113 | /* Switch: '<S155>/Switch' incorporates: |
| 18114 | * Constant: '<S155>/Constant7' |
| 18115 | * Constant: '<S155>/Constant8' |
| 18116 | */ |
| 18117 | if (fusionAlg_B.DataTypeConversion_h5j > fusionAlg_P_g.Switch_Threshold_omz) { |
| 18118 | fusionAlg_B.Switch_ev = fusionAlg_P_g.Constant7_Value_jjx; |
| 18119 | } else { |
| 18120 | fusionAlg_B.Switch_ev = fusionAlg_P_g.Constant8_Value_or; |
| 18121 | } |
| 18122 | |
| 18123 | /* End of Switch: '<S155>/Switch' */ |
| 18124 | |
| 18125 | /* DataTypeConversion: '<S155>/Data Type Conversion1' */ |
| 18126 | tmp = (real32_T)floor(fusionAlg_B.Selector28_g.DynProp); |
| 18127 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18128 | tmp = 0.0F; |
| 18129 | } else { |
| 18130 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18131 | } |
| 18132 | |
| 18133 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objMotionPattern = (uint8_T) |
| 18134 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18135 | tmp); |
| 18136 | |
| 18137 | /* End of DataTypeConversion: '<S155>/Data Type Conversion1' */ |
| 18138 | |
| 18139 | /* BusCreator: '<S155>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18140 | * Constant: '<S155>/Constant' |
| 18141 | * Constant: '<S155>/Constant1' |
| 18142 | */ |
| 18143 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.reserved.reserved1 = |
| 18144 | fusionAlg_P_g.Constant_Value_fn; |
| 18145 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.reserved.reserved0 = |
| 18146 | fusionAlg_P_g.Constant1_Value_jm; |
| 18147 | |
| 18148 | /* BusCreator: '<S155>/Bus Creator1' incorporates: |
| 18149 | * Constant: '<S155>/Constant10' |
| 18150 | * Constant: '<S155>/Constant2' |
| 18151 | * Constant: '<S155>/Constant3' |
| 18152 | * Constant: '<S155>/Constant4' |
| 18153 | * Constant: '<S155>/Constant5' |
| 18154 | * Constant: '<S155>/Constant6' |
| 18155 | * Constant: '<S155>/Constant9' |
| 18156 | */ |
| 18157 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objObstacleProb = |
| 18158 | fusionAlg_B.Selector28_g.RCS; |
| 18159 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objXPos_Stdev = |
| 18160 | fusionAlg_P_g.Constant2_Value_hz; |
| 18161 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objYPos_Stdev = |
| 18162 | fusionAlg_P_g.Constant3_Value_kc; |
| 18163 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objXVelRel_Stdev = |
| 18164 | fusionAlg_P_g.Constant4_Value_ii; |
| 18165 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objXAccRel = |
| 18166 | fusionAlg_P_g.Constant5_Value_lz; |
| 18167 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objExstProb = |
| 18168 | fusionAlg_P_g.Constant6_Value_f3; |
| 18169 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objYVelRel = |
| 18170 | fusionAlg_B.Selector28_g.VrelLat; |
| 18171 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objXVelRel = |
| 18172 | fusionAlg_B.Selector28_g.VrelLong; |
| 18173 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objXPos = |
| 18174 | fusionAlg_B.Selector28_g.DistLong; |
| 18175 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objYPos = |
| 18176 | fusionAlg_B.Selector28_g.DistLat; |
| 18177 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objID = |
| 18178 | fusionAlg_B.DataTypeConversion_h5j; |
| 18179 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objUpdateFlag = |
| 18180 | fusionAlg_B.Switch_ev; |
| 18181 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objValidFlag = |
| 18182 | fusionAlg_B.Switch_ev; |
| 18183 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objType = |
| 18184 | fusionAlg_P_g.Constant9_Value_fw; |
| 18185 | fusionAlg_B.BusCreator_ad.radarObj.radar_22_obj.objMeasFlag = |
| 18186 | fusionAlg_P_g.Constant10_Value_e1; |
| 18187 | |
| 18188 | /* Selector: '<S139>/Selector29' incorporates: |
| 18189 | * Constant: '<S139>/Constant22' |
| 18190 | */ |
| 18191 | fusionAlg_B.Selector29_e = rtu_Radar308_Info_st-> |
| 18192 | rightRearRadar_General[fusionAlg_P_g.Constant22_Value_c]; |
| 18193 | |
| 18194 | /* DataTypeConversion: '<S156>/Data Type Conversion' */ |
| 18195 | tmp = (real32_T)floor(fusionAlg_B.Selector29_e.ID); |
| 18196 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18197 | tmp = 0.0F; |
| 18198 | } else { |
| 18199 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18200 | } |
| 18201 | |
| 18202 | fusionAlg_B.DataTypeConversion_kuy = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 18203 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18204 | |
| 18205 | /* End of DataTypeConversion: '<S156>/Data Type Conversion' */ |
| 18206 | |
| 18207 | /* Switch: '<S156>/Switch' incorporates: |
| 18208 | * Constant: '<S156>/Constant7' |
| 18209 | * Constant: '<S156>/Constant8' |
| 18210 | */ |
| 18211 | if (fusionAlg_B.DataTypeConversion_kuy > fusionAlg_P_g.Switch_Threshold_dg) { |
| 18212 | fusionAlg_B.Switch_dh4 = fusionAlg_P_g.Constant7_Value_lbd; |
| 18213 | } else { |
| 18214 | fusionAlg_B.Switch_dh4 = fusionAlg_P_g.Constant8_Value_g0; |
| 18215 | } |
| 18216 | |
| 18217 | /* End of Switch: '<S156>/Switch' */ |
| 18218 | |
| 18219 | /* DataTypeConversion: '<S156>/Data Type Conversion1' */ |
| 18220 | tmp = (real32_T)floor(fusionAlg_B.Selector29_e.DynProp); |
| 18221 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18222 | tmp = 0.0F; |
| 18223 | } else { |
| 18224 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18225 | } |
| 18226 | |
| 18227 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objMotionPattern = (uint8_T) |
| 18228 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18229 | tmp); |
| 18230 | |
| 18231 | /* End of DataTypeConversion: '<S156>/Data Type Conversion1' */ |
| 18232 | |
| 18233 | /* BusCreator: '<S156>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18234 | * Constant: '<S156>/Constant' |
| 18235 | * Constant: '<S156>/Constant1' |
| 18236 | */ |
| 18237 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.reserved.reserved1 = |
| 18238 | fusionAlg_P_g.Constant_Value_ei; |
| 18239 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.reserved.reserved0 = |
| 18240 | fusionAlg_P_g.Constant1_Value_e3o; |
| 18241 | |
| 18242 | /* BusCreator: '<S156>/Bus Creator1' incorporates: |
| 18243 | * Constant: '<S156>/Constant10' |
| 18244 | * Constant: '<S156>/Constant2' |
| 18245 | * Constant: '<S156>/Constant3' |
| 18246 | * Constant: '<S156>/Constant4' |
| 18247 | * Constant: '<S156>/Constant5' |
| 18248 | * Constant: '<S156>/Constant6' |
| 18249 | * Constant: '<S156>/Constant9' |
| 18250 | */ |
| 18251 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objObstacleProb = |
| 18252 | fusionAlg_B.Selector29_e.RCS; |
| 18253 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objXPos_Stdev = |
| 18254 | fusionAlg_P_g.Constant2_Value_d4; |
| 18255 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objYPos_Stdev = |
| 18256 | fusionAlg_P_g.Constant3_Value_eno; |
| 18257 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objXVelRel_Stdev = |
| 18258 | fusionAlg_P_g.Constant4_Value_di; |
| 18259 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objXAccRel = |
| 18260 | fusionAlg_P_g.Constant5_Value_fk; |
| 18261 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objExstProb = |
| 18262 | fusionAlg_P_g.Constant6_Value_k5z; |
| 18263 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objYVelRel = |
| 18264 | fusionAlg_B.Selector29_e.VrelLat; |
| 18265 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objXVelRel = |
| 18266 | fusionAlg_B.Selector29_e.VrelLong; |
| 18267 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objXPos = |
| 18268 | fusionAlg_B.Selector29_e.DistLong; |
| 18269 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objYPos = |
| 18270 | fusionAlg_B.Selector29_e.DistLat; |
| 18271 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objID = |
| 18272 | fusionAlg_B.DataTypeConversion_kuy; |
| 18273 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objUpdateFlag = |
| 18274 | fusionAlg_B.Switch_dh4; |
| 18275 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objValidFlag = |
| 18276 | fusionAlg_B.Switch_dh4; |
| 18277 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objType = |
| 18278 | fusionAlg_P_g.Constant9_Value_fw1; |
| 18279 | fusionAlg_B.BusCreator_ad.radarObj.radar_23_obj.objMeasFlag = |
| 18280 | fusionAlg_P_g.Constant10_Value_f3; |
| 18281 | |
| 18282 | /* Selector: '<S139>/Selector30' incorporates: |
| 18283 | * Constant: '<S139>/Constant23' |
| 18284 | */ |
| 18285 | fusionAlg_B.Selector30_e = rtu_Radar308_Info_st-> |
| 18286 | rightRearRadar_General[fusionAlg_P_g.Constant23_Value_b]; |
| 18287 | |
| 18288 | /* DataTypeConversion: '<S157>/Data Type Conversion' */ |
| 18289 | tmp = (real32_T)floor(fusionAlg_B.Selector30_e.ID); |
| 18290 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18291 | tmp = 0.0F; |
| 18292 | } else { |
| 18293 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18294 | } |
| 18295 | |
| 18296 | fusionAlg_B.DataTypeConversion_pez = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 18297 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18298 | |
| 18299 | /* End of DataTypeConversion: '<S157>/Data Type Conversion' */ |
| 18300 | |
| 18301 | /* Switch: '<S157>/Switch' incorporates: |
| 18302 | * Constant: '<S157>/Constant7' |
| 18303 | * Constant: '<S157>/Constant8' |
| 18304 | */ |
| 18305 | if (fusionAlg_B.DataTypeConversion_pez > fusionAlg_P_g.Switch_Threshold_na) { |
| 18306 | fusionAlg_B.Switch_j4 = fusionAlg_P_g.Constant7_Value_ef; |
| 18307 | } else { |
| 18308 | fusionAlg_B.Switch_j4 = fusionAlg_P_g.Constant8_Value_oa; |
| 18309 | } |
| 18310 | |
| 18311 | /* End of Switch: '<S157>/Switch' */ |
| 18312 | |
| 18313 | /* DataTypeConversion: '<S157>/Data Type Conversion1' */ |
| 18314 | tmp = (real32_T)floor(fusionAlg_B.Selector30_e.DynProp); |
| 18315 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18316 | tmp = 0.0F; |
| 18317 | } else { |
| 18318 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18319 | } |
| 18320 | |
| 18321 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objMotionPattern = (uint8_T) |
| 18322 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18323 | tmp); |
| 18324 | |
| 18325 | /* End of DataTypeConversion: '<S157>/Data Type Conversion1' */ |
| 18326 | |
| 18327 | /* BusCreator: '<S157>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18328 | * Constant: '<S157>/Constant' |
| 18329 | * Constant: '<S157>/Constant1' |
| 18330 | */ |
| 18331 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.reserved.reserved1 = |
| 18332 | fusionAlg_P_g.Constant_Value_bn; |
| 18333 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.reserved.reserved0 = |
| 18334 | fusionAlg_P_g.Constant1_Value_f2; |
| 18335 | |
| 18336 | /* BusCreator: '<S157>/Bus Creator1' incorporates: |
| 18337 | * Constant: '<S157>/Constant10' |
| 18338 | * Constant: '<S157>/Constant2' |
| 18339 | * Constant: '<S157>/Constant3' |
| 18340 | * Constant: '<S157>/Constant4' |
| 18341 | * Constant: '<S157>/Constant5' |
| 18342 | * Constant: '<S157>/Constant6' |
| 18343 | * Constant: '<S157>/Constant9' |
| 18344 | */ |
| 18345 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objObstacleProb = |
| 18346 | fusionAlg_B.Selector30_e.RCS; |
| 18347 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objXPos_Stdev = |
| 18348 | fusionAlg_P_g.Constant2_Value_ls; |
| 18349 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objYPos_Stdev = |
| 18350 | fusionAlg_P_g.Constant3_Value_de; |
| 18351 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objXVelRel_Stdev = |
| 18352 | fusionAlg_P_g.Constant4_Value_oa; |
| 18353 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objXAccRel = |
| 18354 | fusionAlg_P_g.Constant5_Value_id; |
| 18355 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objExstProb = |
| 18356 | fusionAlg_P_g.Constant6_Value_nq; |
| 18357 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objYVelRel = |
| 18358 | fusionAlg_B.Selector30_e.VrelLat; |
| 18359 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objXVelRel = |
| 18360 | fusionAlg_B.Selector30_e.VrelLong; |
| 18361 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objXPos = |
| 18362 | fusionAlg_B.Selector30_e.DistLong; |
| 18363 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objYPos = |
| 18364 | fusionAlg_B.Selector30_e.DistLat; |
| 18365 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objID = |
| 18366 | fusionAlg_B.DataTypeConversion_pez; |
| 18367 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objUpdateFlag = |
| 18368 | fusionAlg_B.Switch_j4; |
| 18369 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objValidFlag = |
| 18370 | fusionAlg_B.Switch_j4; |
| 18371 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objType = |
| 18372 | fusionAlg_P_g.Constant9_Value_m5; |
| 18373 | fusionAlg_B.BusCreator_ad.radarObj.radar_24_obj.objMeasFlag = |
| 18374 | fusionAlg_P_g.Constant10_Value_od; |
| 18375 | |
| 18376 | /* Selector: '<S139>/Selector17' incorporates: |
| 18377 | * Constant: '<S139>/Constant24' |
| 18378 | */ |
| 18379 | fusionAlg_B.Selector17_fk = rtu_Radar308_Info_st-> |
| 18380 | rightRearRadar_General[fusionAlg_P_g.Constant24_Value_f]; |
| 18381 | |
| 18382 | /* DataTypeConversion: '<S158>/Data Type Conversion' */ |
| 18383 | tmp = (real32_T)floor(fusionAlg_B.Selector17_fk.ID); |
| 18384 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18385 | tmp = 0.0F; |
| 18386 | } else { |
| 18387 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18388 | } |
| 18389 | |
| 18390 | fusionAlg_B.DataTypeConversion_b1o = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 18391 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18392 | |
| 18393 | /* End of DataTypeConversion: '<S158>/Data Type Conversion' */ |
| 18394 | |
| 18395 | /* Switch: '<S158>/Switch' incorporates: |
| 18396 | * Constant: '<S158>/Constant7' |
| 18397 | * Constant: '<S158>/Constant8' |
| 18398 | */ |
| 18399 | if (fusionAlg_B.DataTypeConversion_b1o > fusionAlg_P_g.Switch_Threshold_oo) { |
| 18400 | fusionAlg_B.Switch_bd = fusionAlg_P_g.Constant7_Value_hjs; |
| 18401 | } else { |
| 18402 | fusionAlg_B.Switch_bd = fusionAlg_P_g.Constant8_Value_ke; |
| 18403 | } |
| 18404 | |
| 18405 | /* End of Switch: '<S158>/Switch' */ |
| 18406 | |
| 18407 | /* DataTypeConversion: '<S158>/Data Type Conversion1' */ |
| 18408 | tmp = (real32_T)floor(fusionAlg_B.Selector17_fk.DynProp); |
| 18409 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18410 | tmp = 0.0F; |
| 18411 | } else { |
| 18412 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18413 | } |
| 18414 | |
| 18415 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objMotionPattern = (uint8_T) |
| 18416 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18417 | tmp); |
| 18418 | |
| 18419 | /* End of DataTypeConversion: '<S158>/Data Type Conversion1' */ |
| 18420 | |
| 18421 | /* BusCreator: '<S158>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18422 | * Constant: '<S158>/Constant' |
| 18423 | * Constant: '<S158>/Constant1' |
| 18424 | */ |
| 18425 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.reserved.reserved1 = |
| 18426 | fusionAlg_P_g.Constant_Value_lsl; |
| 18427 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.reserved.reserved0 = |
| 18428 | fusionAlg_P_g.Constant1_Value_go; |
| 18429 | |
| 18430 | /* BusCreator: '<S158>/Bus Creator1' incorporates: |
| 18431 | * Constant: '<S158>/Constant10' |
| 18432 | * Constant: '<S158>/Constant2' |
| 18433 | * Constant: '<S158>/Constant3' |
| 18434 | * Constant: '<S158>/Constant4' |
| 18435 | * Constant: '<S158>/Constant5' |
| 18436 | * Constant: '<S158>/Constant6' |
| 18437 | * Constant: '<S158>/Constant9' |
| 18438 | */ |
| 18439 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objObstacleProb = |
| 18440 | fusionAlg_B.Selector17_fk.RCS; |
| 18441 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objXPos_Stdev = |
| 18442 | fusionAlg_P_g.Constant2_Value_ha; |
| 18443 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objYPos_Stdev = |
| 18444 | fusionAlg_P_g.Constant3_Value_o3y; |
| 18445 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objXVelRel_Stdev = |
| 18446 | fusionAlg_P_g.Constant4_Value_gh; |
| 18447 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objXAccRel = |
| 18448 | fusionAlg_P_g.Constant5_Value_cv; |
| 18449 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objExstProb = |
| 18450 | fusionAlg_P_g.Constant6_Value_bp; |
| 18451 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objYVelRel = |
| 18452 | fusionAlg_B.Selector17_fk.VrelLat; |
| 18453 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objXVelRel = |
| 18454 | fusionAlg_B.Selector17_fk.VrelLong; |
| 18455 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objXPos = |
| 18456 | fusionAlg_B.Selector17_fk.DistLong; |
| 18457 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objYPos = |
| 18458 | fusionAlg_B.Selector17_fk.DistLat; |
| 18459 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objID = |
| 18460 | fusionAlg_B.DataTypeConversion_b1o; |
| 18461 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objUpdateFlag = |
| 18462 | fusionAlg_B.Switch_bd; |
| 18463 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objValidFlag = |
| 18464 | fusionAlg_B.Switch_bd; |
| 18465 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objType = |
| 18466 | fusionAlg_P_g.Constant9_Value_iv; |
| 18467 | fusionAlg_B.BusCreator_ad.radarObj.radar_25_obj.objMeasFlag = |
| 18468 | fusionAlg_P_g.Constant10_Value_hmr; |
| 18469 | |
| 18470 | /* Selector: '<S139>/Selector18' incorporates: |
| 18471 | * Constant: '<S139>/Constant25' |
| 18472 | */ |
| 18473 | fusionAlg_B.Selector18_f = rtu_Radar308_Info_st-> |
| 18474 | rightRearRadar_General[fusionAlg_P_g.Constant25_Value_l]; |
| 18475 | |
| 18476 | /* DataTypeConversion: '<S159>/Data Type Conversion' */ |
| 18477 | tmp = (real32_T)floor(fusionAlg_B.Selector18_f.ID); |
| 18478 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18479 | tmp = 0.0F; |
| 18480 | } else { |
| 18481 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18482 | } |
| 18483 | |
| 18484 | fusionAlg_B.DataTypeConversion_meh = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 18485 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18486 | |
| 18487 | /* End of DataTypeConversion: '<S159>/Data Type Conversion' */ |
| 18488 | |
| 18489 | /* Switch: '<S159>/Switch' incorporates: |
| 18490 | * Constant: '<S159>/Constant7' |
| 18491 | * Constant: '<S159>/Constant8' |
| 18492 | */ |
| 18493 | if (fusionAlg_B.DataTypeConversion_meh > fusionAlg_P_g.Switch_Threshold_g3) { |
| 18494 | fusionAlg_B.Switch_am = fusionAlg_P_g.Constant7_Value_k5; |
| 18495 | } else { |
| 18496 | fusionAlg_B.Switch_am = fusionAlg_P_g.Constant8_Value_nn; |
| 18497 | } |
| 18498 | |
| 18499 | /* End of Switch: '<S159>/Switch' */ |
| 18500 | |
| 18501 | /* DataTypeConversion: '<S159>/Data Type Conversion1' */ |
| 18502 | tmp = (real32_T)floor(fusionAlg_B.Selector18_f.DynProp); |
| 18503 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18504 | tmp = 0.0F; |
| 18505 | } else { |
| 18506 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18507 | } |
| 18508 | |
| 18509 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objMotionPattern = (uint8_T) |
| 18510 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18511 | tmp); |
| 18512 | |
| 18513 | /* End of DataTypeConversion: '<S159>/Data Type Conversion1' */ |
| 18514 | |
| 18515 | /* BusCreator: '<S159>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18516 | * Constant: '<S159>/Constant' |
| 18517 | * Constant: '<S159>/Constant1' |
| 18518 | */ |
| 18519 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.reserved.reserved1 = |
| 18520 | fusionAlg_P_g.Constant_Value_og; |
| 18521 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.reserved.reserved0 = |
| 18522 | fusionAlg_P_g.Constant1_Value_kb; |
| 18523 | |
| 18524 | /* BusCreator: '<S159>/Bus Creator1' incorporates: |
| 18525 | * Constant: '<S159>/Constant10' |
| 18526 | * Constant: '<S159>/Constant2' |
| 18527 | * Constant: '<S159>/Constant3' |
| 18528 | * Constant: '<S159>/Constant4' |
| 18529 | * Constant: '<S159>/Constant5' |
| 18530 | * Constant: '<S159>/Constant6' |
| 18531 | * Constant: '<S159>/Constant9' |
| 18532 | */ |
| 18533 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objObstacleProb = |
| 18534 | fusionAlg_B.Selector18_f.RCS; |
| 18535 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objXPos_Stdev = |
| 18536 | fusionAlg_P_g.Constant2_Value_hk; |
| 18537 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objYPos_Stdev = |
| 18538 | fusionAlg_P_g.Constant3_Value_dr; |
| 18539 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objXVelRel_Stdev = |
| 18540 | fusionAlg_P_g.Constant4_Value_i5g; |
| 18541 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objXAccRel = |
| 18542 | fusionAlg_P_g.Constant5_Value_jg; |
| 18543 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objExstProb = |
| 18544 | fusionAlg_P_g.Constant6_Value_hy; |
| 18545 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objYVelRel = |
| 18546 | fusionAlg_B.Selector18_f.VrelLat; |
| 18547 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objXVelRel = |
| 18548 | fusionAlg_B.Selector18_f.VrelLong; |
| 18549 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objXPos = |
| 18550 | fusionAlg_B.Selector18_f.DistLong; |
| 18551 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objYPos = |
| 18552 | fusionAlg_B.Selector18_f.DistLat; |
| 18553 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objID = |
| 18554 | fusionAlg_B.DataTypeConversion_meh; |
| 18555 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objUpdateFlag = |
| 18556 | fusionAlg_B.Switch_am; |
| 18557 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objValidFlag = |
| 18558 | fusionAlg_B.Switch_am; |
| 18559 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objType = |
| 18560 | fusionAlg_P_g.Constant9_Value_lh; |
| 18561 | fusionAlg_B.BusCreator_ad.radarObj.radar_26_obj.objMeasFlag = |
| 18562 | fusionAlg_P_g.Constant10_Value_i0k; |
| 18563 | |
| 18564 | /* Selector: '<S139>/Selector19' incorporates: |
| 18565 | * Constant: '<S139>/Constant26' |
| 18566 | */ |
| 18567 | fusionAlg_B.Selector19_a = rtu_Radar308_Info_st-> |
| 18568 | rightRearRadar_General[fusionAlg_P_g.Constant26_Value_a]; |
| 18569 | |
| 18570 | /* DataTypeConversion: '<S160>/Data Type Conversion' */ |
| 18571 | tmp = (real32_T)floor(fusionAlg_B.Selector19_a.ID); |
| 18572 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18573 | tmp = 0.0F; |
| 18574 | } else { |
| 18575 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18576 | } |
| 18577 | |
| 18578 | fusionAlg_B.DataTypeConversion_lz = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 18579 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18580 | |
| 18581 | /* End of DataTypeConversion: '<S160>/Data Type Conversion' */ |
| 18582 | |
| 18583 | /* Switch: '<S160>/Switch' incorporates: |
| 18584 | * Constant: '<S160>/Constant7' |
| 18585 | * Constant: '<S160>/Constant8' |
| 18586 | */ |
| 18587 | if (fusionAlg_B.DataTypeConversion_lz > fusionAlg_P_g.Switch_Threshold_fj) { |
| 18588 | fusionAlg_B.Switch_la = fusionAlg_P_g.Constant7_Value_eq; |
| 18589 | } else { |
| 18590 | fusionAlg_B.Switch_la = fusionAlg_P_g.Constant8_Value_d3; |
| 18591 | } |
| 18592 | |
| 18593 | /* End of Switch: '<S160>/Switch' */ |
| 18594 | |
| 18595 | /* DataTypeConversion: '<S160>/Data Type Conversion1' */ |
| 18596 | tmp = (real32_T)floor(fusionAlg_B.Selector19_a.DynProp); |
| 18597 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18598 | tmp = 0.0F; |
| 18599 | } else { |
| 18600 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18601 | } |
| 18602 | |
| 18603 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objMotionPattern = (uint8_T) |
| 18604 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18605 | tmp); |
| 18606 | |
| 18607 | /* End of DataTypeConversion: '<S160>/Data Type Conversion1' */ |
| 18608 | |
| 18609 | /* BusCreator: '<S160>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18610 | * Constant: '<S160>/Constant' |
| 18611 | * Constant: '<S160>/Constant1' |
| 18612 | */ |
| 18613 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.reserved.reserved1 = |
| 18614 | fusionAlg_P_g.Constant_Value_dc; |
| 18615 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.reserved.reserved0 = |
| 18616 | fusionAlg_P_g.Constant1_Value_ch; |
| 18617 | |
| 18618 | /* BusCreator: '<S160>/Bus Creator1' incorporates: |
| 18619 | * Constant: '<S160>/Constant10' |
| 18620 | * Constant: '<S160>/Constant2' |
| 18621 | * Constant: '<S160>/Constant3' |
| 18622 | * Constant: '<S160>/Constant4' |
| 18623 | * Constant: '<S160>/Constant5' |
| 18624 | * Constant: '<S160>/Constant6' |
| 18625 | * Constant: '<S160>/Constant9' |
| 18626 | */ |
| 18627 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objObstacleProb = |
| 18628 | fusionAlg_B.Selector19_a.RCS; |
| 18629 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objXPos_Stdev = |
| 18630 | fusionAlg_P_g.Constant2_Value_gw; |
| 18631 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objYPos_Stdev = |
| 18632 | fusionAlg_P_g.Constant3_Value_ny; |
| 18633 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objXVelRel_Stdev = |
| 18634 | fusionAlg_P_g.Constant4_Value_j1; |
| 18635 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objXAccRel = |
| 18636 | fusionAlg_P_g.Constant5_Value_ga; |
| 18637 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objExstProb = |
| 18638 | fusionAlg_P_g.Constant6_Value_hc; |
| 18639 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objYVelRel = |
| 18640 | fusionAlg_B.Selector19_a.VrelLat; |
| 18641 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objXVelRel = |
| 18642 | fusionAlg_B.Selector19_a.VrelLong; |
| 18643 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objXPos = |
| 18644 | fusionAlg_B.Selector19_a.DistLong; |
| 18645 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objYPos = |
| 18646 | fusionAlg_B.Selector19_a.DistLat; |
| 18647 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objID = |
| 18648 | fusionAlg_B.DataTypeConversion_lz; |
| 18649 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objUpdateFlag = |
| 18650 | fusionAlg_B.Switch_la; |
| 18651 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objValidFlag = |
| 18652 | fusionAlg_B.Switch_la; |
| 18653 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objType = |
| 18654 | fusionAlg_P_g.Constant9_Value_hp; |
| 18655 | fusionAlg_B.BusCreator_ad.radarObj.radar_27_obj.objMeasFlag = |
| 18656 | fusionAlg_P_g.Constant10_Value_ac; |
| 18657 | |
| 18658 | /* Selector: '<S139>/Selector20' incorporates: |
| 18659 | * Constant: '<S139>/Constant27' |
| 18660 | */ |
| 18661 | fusionAlg_B.Selector20_m = rtu_Radar308_Info_st-> |
| 18662 | rightRearRadar_General[fusionAlg_P_g.Constant27_Value_a]; |
| 18663 | |
| 18664 | /* DataTypeConversion: '<S161>/Data Type Conversion' */ |
| 18665 | tmp = (real32_T)floor(fusionAlg_B.Selector20_m.ID); |
| 18666 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18667 | tmp = 0.0F; |
| 18668 | } else { |
| 18669 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18670 | } |
| 18671 | |
| 18672 | fusionAlg_B.DataTypeConversion_h1 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 18673 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18674 | |
| 18675 | /* End of DataTypeConversion: '<S161>/Data Type Conversion' */ |
| 18676 | |
| 18677 | /* Switch: '<S161>/Switch' incorporates: |
| 18678 | * Constant: '<S161>/Constant7' |
| 18679 | * Constant: '<S161>/Constant8' |
| 18680 | */ |
| 18681 | if (fusionAlg_B.DataTypeConversion_h1 > fusionAlg_P_g.Switch_Threshold_fq) { |
| 18682 | fusionAlg_B.Switch_fr = fusionAlg_P_g.Constant7_Value_c5; |
| 18683 | } else { |
| 18684 | fusionAlg_B.Switch_fr = fusionAlg_P_g.Constant8_Value_bdh; |
| 18685 | } |
| 18686 | |
| 18687 | /* End of Switch: '<S161>/Switch' */ |
| 18688 | |
| 18689 | /* DataTypeConversion: '<S161>/Data Type Conversion1' */ |
| 18690 | tmp = (real32_T)floor(fusionAlg_B.Selector20_m.DynProp); |
| 18691 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18692 | tmp = 0.0F; |
| 18693 | } else { |
| 18694 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18695 | } |
| 18696 | |
| 18697 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objMotionPattern = (uint8_T) |
| 18698 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18699 | tmp); |
| 18700 | |
| 18701 | /* End of DataTypeConversion: '<S161>/Data Type Conversion1' */ |
| 18702 | |
| 18703 | /* BusCreator: '<S161>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18704 | * Constant: '<S161>/Constant' |
| 18705 | * Constant: '<S161>/Constant1' |
| 18706 | */ |
| 18707 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.reserved.reserved1 = |
| 18708 | fusionAlg_P_g.Constant_Value_ig; |
| 18709 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.reserved.reserved0 = |
| 18710 | fusionAlg_P_g.Constant1_Value_du; |
| 18711 | |
| 18712 | /* BusCreator: '<S161>/Bus Creator1' incorporates: |
| 18713 | * Constant: '<S161>/Constant10' |
| 18714 | * Constant: '<S161>/Constant2' |
| 18715 | * Constant: '<S161>/Constant3' |
| 18716 | * Constant: '<S161>/Constant4' |
| 18717 | * Constant: '<S161>/Constant5' |
| 18718 | * Constant: '<S161>/Constant6' |
| 18719 | * Constant: '<S161>/Constant9' |
| 18720 | */ |
| 18721 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objObstacleProb = |
| 18722 | fusionAlg_B.Selector20_m.RCS; |
| 18723 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objXPos_Stdev = |
| 18724 | fusionAlg_P_g.Constant2_Value_obo; |
| 18725 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objYPos_Stdev = |
| 18726 | fusionAlg_P_g.Constant3_Value_d0; |
| 18727 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objXVelRel_Stdev = |
| 18728 | fusionAlg_P_g.Constant4_Value_gl; |
| 18729 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objXAccRel = |
| 18730 | fusionAlg_P_g.Constant5_Value_ig; |
| 18731 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objExstProb = |
| 18732 | fusionAlg_P_g.Constant6_Value_fc; |
| 18733 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objYVelRel = |
| 18734 | fusionAlg_B.Selector20_m.VrelLat; |
| 18735 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objXVelRel = |
| 18736 | fusionAlg_B.Selector20_m.VrelLong; |
| 18737 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objXPos = |
| 18738 | fusionAlg_B.Selector20_m.DistLong; |
| 18739 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objYPos = |
| 18740 | fusionAlg_B.Selector20_m.DistLat; |
| 18741 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objID = |
| 18742 | fusionAlg_B.DataTypeConversion_h1; |
| 18743 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objUpdateFlag = |
| 18744 | fusionAlg_B.Switch_fr; |
| 18745 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objValidFlag = |
| 18746 | fusionAlg_B.Switch_fr; |
| 18747 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objType = |
| 18748 | fusionAlg_P_g.Constant9_Value_fu; |
| 18749 | fusionAlg_B.BusCreator_ad.radarObj.radar_28_obj.objMeasFlag = |
| 18750 | fusionAlg_P_g.Constant10_Value_ni; |
| 18751 | |
| 18752 | /* Selector: '<S139>/Selector21' incorporates: |
| 18753 | * Constant: '<S139>/Constant28' |
| 18754 | */ |
| 18755 | fusionAlg_B.Selector21_o = rtu_Radar308_Info_st-> |
| 18756 | rightRearRadar_General[fusionAlg_P_g.Constant28_Value_l]; |
| 18757 | |
| 18758 | /* DataTypeConversion: '<S162>/Data Type Conversion' */ |
| 18759 | tmp = (real32_T)floor(fusionAlg_B.Selector21_o.ID); |
| 18760 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18761 | tmp = 0.0F; |
| 18762 | } else { |
| 18763 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18764 | } |
| 18765 | |
| 18766 | fusionAlg_B.DataTypeConversion_ok2 = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 18767 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18768 | |
| 18769 | /* End of DataTypeConversion: '<S162>/Data Type Conversion' */ |
| 18770 | |
| 18771 | /* Switch: '<S162>/Switch' incorporates: |
| 18772 | * Constant: '<S162>/Constant7' |
| 18773 | * Constant: '<S162>/Constant8' |
| 18774 | */ |
| 18775 | if (fusionAlg_B.DataTypeConversion_ok2 > fusionAlg_P_g.Switch_Threshold_f3) { |
| 18776 | fusionAlg_B.Switch_k5 = fusionAlg_P_g.Constant7_Value_fj; |
| 18777 | } else { |
| 18778 | fusionAlg_B.Switch_k5 = fusionAlg_P_g.Constant8_Value_lu; |
| 18779 | } |
| 18780 | |
| 18781 | /* End of Switch: '<S162>/Switch' */ |
| 18782 | |
| 18783 | /* DataTypeConversion: '<S162>/Data Type Conversion1' */ |
| 18784 | tmp = (real32_T)floor(fusionAlg_B.Selector21_o.DynProp); |
| 18785 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18786 | tmp = 0.0F; |
| 18787 | } else { |
| 18788 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18789 | } |
| 18790 | |
| 18791 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objMotionPattern = (uint8_T) |
| 18792 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18793 | tmp); |
| 18794 | |
| 18795 | /* End of DataTypeConversion: '<S162>/Data Type Conversion1' */ |
| 18796 | |
| 18797 | /* BusCreator: '<S162>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18798 | * Constant: '<S162>/Constant' |
| 18799 | * Constant: '<S162>/Constant1' |
| 18800 | */ |
| 18801 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.reserved.reserved1 = |
| 18802 | fusionAlg_P_g.Constant_Value_dcf; |
| 18803 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.reserved.reserved0 = |
| 18804 | fusionAlg_P_g.Constant1_Value_jb; |
| 18805 | |
| 18806 | /* BusCreator: '<S162>/Bus Creator1' incorporates: |
| 18807 | * Constant: '<S162>/Constant10' |
| 18808 | * Constant: '<S162>/Constant2' |
| 18809 | * Constant: '<S162>/Constant3' |
| 18810 | * Constant: '<S162>/Constant4' |
| 18811 | * Constant: '<S162>/Constant5' |
| 18812 | * Constant: '<S162>/Constant6' |
| 18813 | * Constant: '<S162>/Constant9' |
| 18814 | */ |
| 18815 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objObstacleProb = |
| 18816 | fusionAlg_B.Selector21_o.RCS; |
| 18817 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objXPos_Stdev = |
| 18818 | fusionAlg_P_g.Constant2_Value_ow; |
| 18819 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objYPos_Stdev = |
| 18820 | fusionAlg_P_g.Constant3_Value_m2; |
| 18821 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objXVelRel_Stdev = |
| 18822 | fusionAlg_P_g.Constant4_Value_js; |
| 18823 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objXAccRel = |
| 18824 | fusionAlg_P_g.Constant5_Value_nh; |
| 18825 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objExstProb = |
| 18826 | fusionAlg_P_g.Constant6_Value_ho; |
| 18827 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objYVelRel = |
| 18828 | fusionAlg_B.Selector21_o.VrelLat; |
| 18829 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objXVelRel = |
| 18830 | fusionAlg_B.Selector21_o.VrelLong; |
| 18831 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objXPos = |
| 18832 | fusionAlg_B.Selector21_o.DistLong; |
| 18833 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objYPos = |
| 18834 | fusionAlg_B.Selector21_o.DistLat; |
| 18835 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objID = |
| 18836 | fusionAlg_B.DataTypeConversion_ok2; |
| 18837 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objUpdateFlag = |
| 18838 | fusionAlg_B.Switch_k5; |
| 18839 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objValidFlag = |
| 18840 | fusionAlg_B.Switch_k5; |
| 18841 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objType = |
| 18842 | fusionAlg_P_g.Constant9_Value_a0; |
| 18843 | fusionAlg_B.BusCreator_ad.radarObj.radar_29_obj.objMeasFlag = |
| 18844 | fusionAlg_P_g.Constant10_Value_mv; |
| 18845 | |
| 18846 | /* Selector: '<S139>/Selector22' incorporates: |
| 18847 | * Constant: '<S139>/Constant29' |
| 18848 | */ |
| 18849 | fusionAlg_B.Selector22_i = rtu_Radar308_Info_st-> |
| 18850 | rightRearRadar_General[fusionAlg_P_g.Constant29_Value_d]; |
| 18851 | |
| 18852 | /* DataTypeConversion: '<S164>/Data Type Conversion' */ |
| 18853 | tmp = (real32_T)floor(fusionAlg_B.Selector22_i.ID); |
| 18854 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18855 | tmp = 0.0F; |
| 18856 | } else { |
| 18857 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18858 | } |
| 18859 | |
| 18860 | fusionAlg_B.DataTypeConversion_n0 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 18861 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18862 | |
| 18863 | /* End of DataTypeConversion: '<S164>/Data Type Conversion' */ |
| 18864 | |
| 18865 | /* Switch: '<S164>/Switch' incorporates: |
| 18866 | * Constant: '<S164>/Constant7' |
| 18867 | * Constant: '<S164>/Constant8' |
| 18868 | */ |
| 18869 | if (fusionAlg_B.DataTypeConversion_n0 > fusionAlg_P_g.Switch_Threshold_ha) { |
| 18870 | fusionAlg_B.Switch_b0 = fusionAlg_P_g.Constant7_Value_oz; |
| 18871 | } else { |
| 18872 | fusionAlg_B.Switch_b0 = fusionAlg_P_g.Constant8_Value_h3; |
| 18873 | } |
| 18874 | |
| 18875 | /* End of Switch: '<S164>/Switch' */ |
| 18876 | |
| 18877 | /* DataTypeConversion: '<S164>/Data Type Conversion1' */ |
| 18878 | tmp = (real32_T)floor(fusionAlg_B.Selector22_i.DynProp); |
| 18879 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18880 | tmp = 0.0F; |
| 18881 | } else { |
| 18882 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18883 | } |
| 18884 | |
| 18885 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objMotionPattern = (uint8_T) |
| 18886 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18887 | tmp); |
| 18888 | |
| 18889 | /* End of DataTypeConversion: '<S164>/Data Type Conversion1' */ |
| 18890 | |
| 18891 | /* BusCreator: '<S164>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18892 | * Constant: '<S164>/Constant' |
| 18893 | * Constant: '<S164>/Constant1' |
| 18894 | */ |
| 18895 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.reserved.reserved1 = |
| 18896 | fusionAlg_P_g.Constant_Value_ho; |
| 18897 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.reserved.reserved0 = |
| 18898 | fusionAlg_P_g.Constant1_Value_cl; |
| 18899 | |
| 18900 | /* BusCreator: '<S164>/Bus Creator1' incorporates: |
| 18901 | * Constant: '<S164>/Constant10' |
| 18902 | * Constant: '<S164>/Constant2' |
| 18903 | * Constant: '<S164>/Constant3' |
| 18904 | * Constant: '<S164>/Constant4' |
| 18905 | * Constant: '<S164>/Constant5' |
| 18906 | * Constant: '<S164>/Constant6' |
| 18907 | * Constant: '<S164>/Constant9' |
| 18908 | */ |
| 18909 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objObstacleProb = |
| 18910 | fusionAlg_B.Selector22_i.RCS; |
| 18911 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objXPos_Stdev = |
| 18912 | fusionAlg_P_g.Constant2_Value_hps; |
| 18913 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objYPos_Stdev = |
| 18914 | fusionAlg_P_g.Constant3_Value_pd; |
| 18915 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objXVelRel_Stdev = |
| 18916 | fusionAlg_P_g.Constant4_Value_hq; |
| 18917 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objXAccRel = |
| 18918 | fusionAlg_P_g.Constant5_Value_fkk; |
| 18919 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objExstProb = |
| 18920 | fusionAlg_P_g.Constant6_Value_p1; |
| 18921 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objYVelRel = |
| 18922 | fusionAlg_B.Selector22_i.VrelLat; |
| 18923 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objXVelRel = |
| 18924 | fusionAlg_B.Selector22_i.VrelLong; |
| 18925 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objXPos = |
| 18926 | fusionAlg_B.Selector22_i.DistLong; |
| 18927 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objYPos = |
| 18928 | fusionAlg_B.Selector22_i.DistLat; |
| 18929 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objID = |
| 18930 | fusionAlg_B.DataTypeConversion_n0; |
| 18931 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objUpdateFlag = |
| 18932 | fusionAlg_B.Switch_b0; |
| 18933 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objValidFlag = |
| 18934 | fusionAlg_B.Switch_b0; |
| 18935 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objType = |
| 18936 | fusionAlg_P_g.Constant9_Value_ol; |
| 18937 | fusionAlg_B.BusCreator_ad.radarObj.radar_30_obj.objMeasFlag = |
| 18938 | fusionAlg_P_g.Constant10_Value_fg; |
| 18939 | |
| 18940 | /* Selector: '<S139>/Selector23' incorporates: |
| 18941 | * Constant: '<S139>/Constant30' |
| 18942 | */ |
| 18943 | fusionAlg_B.Selector23_o = rtu_Radar308_Info_st-> |
| 18944 | rightRearRadar_General[fusionAlg_P_g.Constant30_Value_f]; |
| 18945 | |
| 18946 | /* DataTypeConversion: '<S165>/Data Type Conversion' */ |
| 18947 | tmp = (real32_T)floor(fusionAlg_B.Selector23_o.ID); |
| 18948 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18949 | tmp = 0.0F; |
| 18950 | } else { |
| 18951 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 18952 | } |
| 18953 | |
| 18954 | fusionAlg_B.DataTypeConversion_jc = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 18955 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 18956 | |
| 18957 | /* End of DataTypeConversion: '<S165>/Data Type Conversion' */ |
| 18958 | |
| 18959 | /* Switch: '<S165>/Switch' incorporates: |
| 18960 | * Constant: '<S165>/Constant7' |
| 18961 | * Constant: '<S165>/Constant8' |
| 18962 | */ |
| 18963 | if (fusionAlg_B.DataTypeConversion_jc > fusionAlg_P_g.Switch_Threshold_bcw) { |
| 18964 | fusionAlg_B.Switch_ln = fusionAlg_P_g.Constant7_Value_jr; |
| 18965 | } else { |
| 18966 | fusionAlg_B.Switch_ln = fusionAlg_P_g.Constant8_Value_el; |
| 18967 | } |
| 18968 | |
| 18969 | /* End of Switch: '<S165>/Switch' */ |
| 18970 | |
| 18971 | /* DataTypeConversion: '<S165>/Data Type Conversion1' */ |
| 18972 | tmp = (real32_T)floor(fusionAlg_B.Selector23_o.DynProp); |
| 18973 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 18974 | tmp = 0.0F; |
| 18975 | } else { |
| 18976 | tmp = (real32_T)fmod(tmp, 256.0); |
| 18977 | } |
| 18978 | |
| 18979 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objMotionPattern = (uint8_T) |
| 18980 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 18981 | tmp); |
| 18982 | |
| 18983 | /* End of DataTypeConversion: '<S165>/Data Type Conversion1' */ |
| 18984 | |
| 18985 | /* BusCreator: '<S165>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 18986 | * Constant: '<S165>/Constant' |
| 18987 | * Constant: '<S165>/Constant1' |
| 18988 | */ |
| 18989 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.reserved.reserved1 = |
| 18990 | fusionAlg_P_g.Constant_Value_ens; |
| 18991 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.reserved.reserved0 = |
| 18992 | fusionAlg_P_g.Constant1_Value_fr; |
| 18993 | |
| 18994 | /* BusCreator: '<S165>/Bus Creator1' incorporates: |
| 18995 | * Constant: '<S165>/Constant10' |
| 18996 | * Constant: '<S165>/Constant2' |
| 18997 | * Constant: '<S165>/Constant3' |
| 18998 | * Constant: '<S165>/Constant4' |
| 18999 | * Constant: '<S165>/Constant5' |
| 19000 | * Constant: '<S165>/Constant6' |
| 19001 | * Constant: '<S165>/Constant9' |
| 19002 | */ |
| 19003 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objObstacleProb = |
| 19004 | fusionAlg_B.Selector23_o.RCS; |
| 19005 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objXPos_Stdev = |
| 19006 | fusionAlg_P_g.Constant2_Value_au; |
| 19007 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objYPos_Stdev = |
| 19008 | fusionAlg_P_g.Constant3_Value_prz; |
| 19009 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objXVelRel_Stdev = |
| 19010 | fusionAlg_P_g.Constant4_Value_ns; |
| 19011 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objXAccRel = |
| 19012 | fusionAlg_P_g.Constant5_Value_px; |
| 19013 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objExstProb = |
| 19014 | fusionAlg_P_g.Constant6_Value_cw; |
| 19015 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objYVelRel = |
| 19016 | fusionAlg_B.Selector23_o.VrelLat; |
| 19017 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objXVelRel = |
| 19018 | fusionAlg_B.Selector23_o.VrelLong; |
| 19019 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objXPos = |
| 19020 | fusionAlg_B.Selector23_o.DistLong; |
| 19021 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objYPos = |
| 19022 | fusionAlg_B.Selector23_o.DistLat; |
| 19023 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objID = |
| 19024 | fusionAlg_B.DataTypeConversion_jc; |
| 19025 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objUpdateFlag = |
| 19026 | fusionAlg_B.Switch_ln; |
| 19027 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objValidFlag = |
| 19028 | fusionAlg_B.Switch_ln; |
| 19029 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objType = |
| 19030 | fusionAlg_P_g.Constant9_Value_ga; |
| 19031 | fusionAlg_B.BusCreator_ad.radarObj.radar_31_obj.objMeasFlag = |
| 19032 | fusionAlg_P_g.Constant10_Value_hy; |
| 19033 | |
| 19034 | /* Selector: '<S139>/Selector31' incorporates: |
| 19035 | * Constant: '<S139>/Constant31' |
| 19036 | */ |
| 19037 | fusionAlg_B.Selector31_p = rtu_Radar308_Info_st-> |
| 19038 | rightRearRadar_General[fusionAlg_P_g.Constant31_Value_d]; |
| 19039 | |
| 19040 | /* DataTypeConversion: '<S166>/Data Type Conversion' */ |
| 19041 | tmp = (real32_T)floor(fusionAlg_B.Selector31_p.ID); |
| 19042 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19043 | tmp = 0.0F; |
| 19044 | } else { |
| 19045 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19046 | } |
| 19047 | |
| 19048 | fusionAlg_B.DataTypeConversion_jy = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 19049 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19050 | |
| 19051 | /* End of DataTypeConversion: '<S166>/Data Type Conversion' */ |
| 19052 | |
| 19053 | /* Switch: '<S166>/Switch' incorporates: |
| 19054 | * Constant: '<S166>/Constant7' |
| 19055 | * Constant: '<S166>/Constant8' |
| 19056 | */ |
| 19057 | if (fusionAlg_B.DataTypeConversion_jy > fusionAlg_P_g.Switch_Threshold_dk) { |
| 19058 | fusionAlg_B.Switch_m35 = fusionAlg_P_g.Constant7_Value_kj; |
| 19059 | } else { |
| 19060 | fusionAlg_B.Switch_m35 = fusionAlg_P_g.Constant8_Value_fc; |
| 19061 | } |
| 19062 | |
| 19063 | /* End of Switch: '<S166>/Switch' */ |
| 19064 | |
| 19065 | /* DataTypeConversion: '<S166>/Data Type Conversion1' */ |
| 19066 | tmp = (real32_T)floor(fusionAlg_B.Selector31_p.DynProp); |
| 19067 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19068 | tmp = 0.0F; |
| 19069 | } else { |
| 19070 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19071 | } |
| 19072 | |
| 19073 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objMotionPattern = (uint8_T) |
| 19074 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 19075 | tmp); |
| 19076 | |
| 19077 | /* End of DataTypeConversion: '<S166>/Data Type Conversion1' */ |
| 19078 | |
| 19079 | /* BusCreator: '<S166>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 19080 | * Constant: '<S166>/Constant' |
| 19081 | * Constant: '<S166>/Constant1' |
| 19082 | */ |
| 19083 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.reserved.reserved1 = |
| 19084 | fusionAlg_P_g.Constant_Value_aw1; |
| 19085 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.reserved.reserved0 = |
| 19086 | fusionAlg_P_g.Constant1_Value_ej; |
| 19087 | |
| 19088 | /* BusCreator: '<S166>/Bus Creator1' incorporates: |
| 19089 | * Constant: '<S166>/Constant10' |
| 19090 | * Constant: '<S166>/Constant2' |
| 19091 | * Constant: '<S166>/Constant3' |
| 19092 | * Constant: '<S166>/Constant4' |
| 19093 | * Constant: '<S166>/Constant5' |
| 19094 | * Constant: '<S166>/Constant6' |
| 19095 | * Constant: '<S166>/Constant9' |
| 19096 | */ |
| 19097 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objObstacleProb = |
| 19098 | fusionAlg_B.Selector31_p.RCS; |
| 19099 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objXPos_Stdev = |
| 19100 | fusionAlg_P_g.Constant2_Value_ae; |
| 19101 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objYPos_Stdev = |
| 19102 | fusionAlg_P_g.Constant3_Value_kt; |
| 19103 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objXVelRel_Stdev = |
| 19104 | fusionAlg_P_g.Constant4_Value_c4; |
| 19105 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objXAccRel = |
| 19106 | fusionAlg_P_g.Constant5_Value_em; |
| 19107 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objExstProb = |
| 19108 | fusionAlg_P_g.Constant6_Value_if; |
| 19109 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objYVelRel = |
| 19110 | fusionAlg_B.Selector31_p.VrelLat; |
| 19111 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objXVelRel = |
| 19112 | fusionAlg_B.Selector31_p.VrelLong; |
| 19113 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objXPos = |
| 19114 | fusionAlg_B.Selector31_p.DistLong; |
| 19115 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objYPos = |
| 19116 | fusionAlg_B.Selector31_p.DistLat; |
| 19117 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objID = |
| 19118 | fusionAlg_B.DataTypeConversion_jy; |
| 19119 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objUpdateFlag = |
| 19120 | fusionAlg_B.Switch_m35; |
| 19121 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objValidFlag = |
| 19122 | fusionAlg_B.Switch_m35; |
| 19123 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objType = |
| 19124 | fusionAlg_P_g.Constant9_Value_n13; |
| 19125 | fusionAlg_B.BusCreator_ad.radarObj.radar_32_obj.objMeasFlag = |
| 19126 | fusionAlg_P_g.Constant10_Value_igv; |
| 19127 | |
| 19128 | /* Selector: '<S139>/Selector32' incorporates: |
| 19129 | * Constant: '<S139>/Constant32' |
| 19130 | */ |
| 19131 | fusionAlg_B.Selector32_l = rtu_Radar308_Info_st-> |
| 19132 | rightRearRadar_General[fusionAlg_P_g.Constant32_Value_b]; |
| 19133 | |
| 19134 | /* DataTypeConversion: '<S167>/Data Type Conversion' */ |
| 19135 | tmp = (real32_T)floor(fusionAlg_B.Selector32_l.ID); |
| 19136 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19137 | tmp = 0.0F; |
| 19138 | } else { |
| 19139 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19140 | } |
| 19141 | |
| 19142 | fusionAlg_B.DataTypeConversion_hl = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 19143 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19144 | |
| 19145 | /* End of DataTypeConversion: '<S167>/Data Type Conversion' */ |
| 19146 | |
| 19147 | /* Switch: '<S167>/Switch' incorporates: |
| 19148 | * Constant: '<S167>/Constant7' |
| 19149 | * Constant: '<S167>/Constant8' |
| 19150 | */ |
| 19151 | if (fusionAlg_B.DataTypeConversion_hl > fusionAlg_P_g.Switch_Threshold_jn) { |
| 19152 | fusionAlg_B.Switch_oe = fusionAlg_P_g.Constant7_Value_lp; |
| 19153 | } else { |
| 19154 | fusionAlg_B.Switch_oe = fusionAlg_P_g.Constant8_Value_ars; |
| 19155 | } |
| 19156 | |
| 19157 | /* End of Switch: '<S167>/Switch' */ |
| 19158 | |
| 19159 | /* DataTypeConversion: '<S167>/Data Type Conversion1' */ |
| 19160 | tmp = (real32_T)floor(fusionAlg_B.Selector32_l.DynProp); |
| 19161 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19162 | tmp = 0.0F; |
| 19163 | } else { |
| 19164 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19165 | } |
| 19166 | |
| 19167 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objMotionPattern = (uint8_T) |
| 19168 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 19169 | tmp); |
| 19170 | |
| 19171 | /* End of DataTypeConversion: '<S167>/Data Type Conversion1' */ |
| 19172 | |
| 19173 | /* BusCreator: '<S167>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 19174 | * Constant: '<S167>/Constant' |
| 19175 | * Constant: '<S167>/Constant1' |
| 19176 | */ |
| 19177 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.reserved.reserved1 = |
| 19178 | fusionAlg_P_g.Constant_Value_bb; |
| 19179 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.reserved.reserved0 = |
| 19180 | fusionAlg_P_g.Constant1_Value_mwj; |
| 19181 | |
| 19182 | /* BusCreator: '<S167>/Bus Creator1' incorporates: |
| 19183 | * Constant: '<S167>/Constant10' |
| 19184 | * Constant: '<S167>/Constant2' |
| 19185 | * Constant: '<S167>/Constant3' |
| 19186 | * Constant: '<S167>/Constant4' |
| 19187 | * Constant: '<S167>/Constant5' |
| 19188 | * Constant: '<S167>/Constant6' |
| 19189 | * Constant: '<S167>/Constant9' |
| 19190 | */ |
| 19191 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objObstacleProb = |
| 19192 | fusionAlg_B.Selector32_l.RCS; |
| 19193 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objXPos_Stdev = |
| 19194 | fusionAlg_P_g.Constant2_Value_gk; |
| 19195 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objYPos_Stdev = |
| 19196 | fusionAlg_P_g.Constant3_Value_by; |
| 19197 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objXVelRel_Stdev = |
| 19198 | fusionAlg_P_g.Constant4_Value_jx; |
| 19199 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objXAccRel = |
| 19200 | fusionAlg_P_g.Constant5_Value_gx; |
| 19201 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objExstProb = |
| 19202 | fusionAlg_P_g.Constant6_Value_o2; |
| 19203 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objYVelRel = |
| 19204 | fusionAlg_B.Selector32_l.VrelLat; |
| 19205 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objXVelRel = |
| 19206 | fusionAlg_B.Selector32_l.VrelLong; |
| 19207 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objXPos = |
| 19208 | fusionAlg_B.Selector32_l.DistLong; |
| 19209 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objYPos = |
| 19210 | fusionAlg_B.Selector32_l.DistLat; |
| 19211 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objID = |
| 19212 | fusionAlg_B.DataTypeConversion_hl; |
| 19213 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objUpdateFlag = |
| 19214 | fusionAlg_B.Switch_oe; |
| 19215 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objValidFlag = |
| 19216 | fusionAlg_B.Switch_oe; |
| 19217 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objType = |
| 19218 | fusionAlg_P_g.Constant9_Value_eo; |
| 19219 | fusionAlg_B.BusCreator_ad.radarObj.radar_33_obj.objMeasFlag = |
| 19220 | fusionAlg_P_g.Constant10_Value_pt; |
| 19221 | |
| 19222 | /* Selector: '<S139>/Selector33' incorporates: |
| 19223 | * Constant: '<S139>/Constant33' |
| 19224 | */ |
| 19225 | fusionAlg_B.Selector33_mh = rtu_Radar308_Info_st-> |
| 19226 | rightRearRadar_General[fusionAlg_P_g.Constant33_Value_k2]; |
| 19227 | |
| 19228 | /* DataTypeConversion: '<S168>/Data Type Conversion' */ |
| 19229 | tmp = (real32_T)floor(fusionAlg_B.Selector33_mh.ID); |
| 19230 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19231 | tmp = 0.0F; |
| 19232 | } else { |
| 19233 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19234 | } |
| 19235 | |
| 19236 | fusionAlg_B.DataTypeConversion_bxx = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 19237 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19238 | |
| 19239 | /* End of DataTypeConversion: '<S168>/Data Type Conversion' */ |
| 19240 | |
| 19241 | /* Switch: '<S168>/Switch' incorporates: |
| 19242 | * Constant: '<S168>/Constant7' |
| 19243 | * Constant: '<S168>/Constant8' |
| 19244 | */ |
| 19245 | if (fusionAlg_B.DataTypeConversion_bxx > fusionAlg_P_g.Switch_Threshold_l1) { |
| 19246 | fusionAlg_B.Switch_nt5 = fusionAlg_P_g.Constant7_Value_n2; |
| 19247 | } else { |
| 19248 | fusionAlg_B.Switch_nt5 = fusionAlg_P_g.Constant8_Value_p; |
| 19249 | } |
| 19250 | |
| 19251 | /* End of Switch: '<S168>/Switch' */ |
| 19252 | |
| 19253 | /* DataTypeConversion: '<S168>/Data Type Conversion1' */ |
| 19254 | tmp = (real32_T)floor(fusionAlg_B.Selector33_mh.DynProp); |
| 19255 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19256 | tmp = 0.0F; |
| 19257 | } else { |
| 19258 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19259 | } |
| 19260 | |
| 19261 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objMotionPattern = (uint8_T) |
| 19262 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 19263 | tmp); |
| 19264 | |
| 19265 | /* End of DataTypeConversion: '<S168>/Data Type Conversion1' */ |
| 19266 | |
| 19267 | /* BusCreator: '<S168>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 19268 | * Constant: '<S168>/Constant' |
| 19269 | * Constant: '<S168>/Constant1' |
| 19270 | */ |
| 19271 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.reserved.reserved1 = |
| 19272 | fusionAlg_P_g.Constant_Value_c0m; |
| 19273 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.reserved.reserved0 = |
| 19274 | fusionAlg_P_g.Constant1_Value_j0; |
| 19275 | |
| 19276 | /* BusCreator: '<S168>/Bus Creator1' incorporates: |
| 19277 | * Constant: '<S168>/Constant10' |
| 19278 | * Constant: '<S168>/Constant2' |
| 19279 | * Constant: '<S168>/Constant3' |
| 19280 | * Constant: '<S168>/Constant4' |
| 19281 | * Constant: '<S168>/Constant5' |
| 19282 | * Constant: '<S168>/Constant6' |
| 19283 | * Constant: '<S168>/Constant9' |
| 19284 | */ |
| 19285 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objObstacleProb = |
| 19286 | fusionAlg_B.Selector33_mh.RCS; |
| 19287 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objXPos_Stdev = |
| 19288 | fusionAlg_P_g.Constant2_Value_cg; |
| 19289 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objYPos_Stdev = |
| 19290 | fusionAlg_P_g.Constant3_Value_go; |
| 19291 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objXVelRel_Stdev = |
| 19292 | fusionAlg_P_g.Constant4_Value_ffi; |
| 19293 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objXAccRel = |
| 19294 | fusionAlg_P_g.Constant5_Value_g2; |
| 19295 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objExstProb = |
| 19296 | fusionAlg_P_g.Constant6_Value_mp; |
| 19297 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objYVelRel = |
| 19298 | fusionAlg_B.Selector33_mh.VrelLat; |
| 19299 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objXVelRel = |
| 19300 | fusionAlg_B.Selector33_mh.VrelLong; |
| 19301 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objXPos = |
| 19302 | fusionAlg_B.Selector33_mh.DistLong; |
| 19303 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objYPos = |
| 19304 | fusionAlg_B.Selector33_mh.DistLat; |
| 19305 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objID = |
| 19306 | fusionAlg_B.DataTypeConversion_bxx; |
| 19307 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objUpdateFlag = |
| 19308 | fusionAlg_B.Switch_nt5; |
| 19309 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objValidFlag = |
| 19310 | fusionAlg_B.Switch_nt5; |
| 19311 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objType = |
| 19312 | fusionAlg_P_g.Constant9_Value_bk; |
| 19313 | fusionAlg_B.BusCreator_ad.radarObj.radar_34_obj.objMeasFlag = |
| 19314 | fusionAlg_P_g.Constant10_Value_dtq; |
| 19315 | |
| 19316 | /* Selector: '<S139>/Selector34' incorporates: |
| 19317 | * Constant: '<S139>/Constant34' |
| 19318 | */ |
| 19319 | fusionAlg_B.Selector34_h = rtu_Radar308_Info_st-> |
| 19320 | rightRearRadar_General[fusionAlg_P_g.Constant34_Value_p]; |
| 19321 | |
| 19322 | /* DataTypeConversion: '<S169>/Data Type Conversion' */ |
| 19323 | tmp = (real32_T)floor(fusionAlg_B.Selector34_h.ID); |
| 19324 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19325 | tmp = 0.0F; |
| 19326 | } else { |
| 19327 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19328 | } |
| 19329 | |
| 19330 | fusionAlg_B.DataTypeConversion_gi = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 19331 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19332 | |
| 19333 | /* End of DataTypeConversion: '<S169>/Data Type Conversion' */ |
| 19334 | |
| 19335 | /* Switch: '<S169>/Switch' incorporates: |
| 19336 | * Constant: '<S169>/Constant7' |
| 19337 | * Constant: '<S169>/Constant8' |
| 19338 | */ |
| 19339 | if (fusionAlg_B.DataTypeConversion_gi > fusionAlg_P_g.Switch_Threshold_f1s) { |
| 19340 | fusionAlg_B.Switch_fy2 = fusionAlg_P_g.Constant7_Value_n1; |
| 19341 | } else { |
| 19342 | fusionAlg_B.Switch_fy2 = fusionAlg_P_g.Constant8_Value_dg; |
| 19343 | } |
| 19344 | |
| 19345 | /* End of Switch: '<S169>/Switch' */ |
| 19346 | |
| 19347 | /* DataTypeConversion: '<S169>/Data Type Conversion1' */ |
| 19348 | tmp = (real32_T)floor(fusionAlg_B.Selector34_h.DynProp); |
| 19349 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19350 | tmp = 0.0F; |
| 19351 | } else { |
| 19352 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19353 | } |
| 19354 | |
| 19355 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objMotionPattern = (uint8_T) |
| 19356 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 19357 | tmp); |
| 19358 | |
| 19359 | /* End of DataTypeConversion: '<S169>/Data Type Conversion1' */ |
| 19360 | |
| 19361 | /* BusCreator: '<S169>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 19362 | * Constant: '<S169>/Constant' |
| 19363 | * Constant: '<S169>/Constant1' |
| 19364 | */ |
| 19365 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.reserved.reserved1 = |
| 19366 | fusionAlg_P_g.Constant_Value_ie; |
| 19367 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.reserved.reserved0 = |
| 19368 | fusionAlg_P_g.Constant1_Value_me; |
| 19369 | |
| 19370 | /* BusCreator: '<S169>/Bus Creator1' incorporates: |
| 19371 | * Constant: '<S169>/Constant10' |
| 19372 | * Constant: '<S169>/Constant2' |
| 19373 | * Constant: '<S169>/Constant3' |
| 19374 | * Constant: '<S169>/Constant4' |
| 19375 | * Constant: '<S169>/Constant5' |
| 19376 | * Constant: '<S169>/Constant6' |
| 19377 | * Constant: '<S169>/Constant9' |
| 19378 | */ |
| 19379 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objObstacleProb = |
| 19380 | fusionAlg_B.Selector34_h.RCS; |
| 19381 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objXPos_Stdev = |
| 19382 | fusionAlg_P_g.Constant2_Value_lg; |
| 19383 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objYPos_Stdev = |
| 19384 | fusionAlg_P_g.Constant3_Value_hv; |
| 19385 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objXVelRel_Stdev = |
| 19386 | fusionAlg_P_g.Constant4_Value_jo; |
| 19387 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objXAccRel = |
| 19388 | fusionAlg_P_g.Constant5_Value_ozk; |
| 19389 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objExstProb = |
| 19390 | fusionAlg_P_g.Constant6_Value_j45; |
| 19391 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objYVelRel = |
| 19392 | fusionAlg_B.Selector34_h.VrelLat; |
| 19393 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objXVelRel = |
| 19394 | fusionAlg_B.Selector34_h.VrelLong; |
| 19395 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objXPos = |
| 19396 | fusionAlg_B.Selector34_h.DistLong; |
| 19397 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objYPos = |
| 19398 | fusionAlg_B.Selector34_h.DistLat; |
| 19399 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objID = |
| 19400 | fusionAlg_B.DataTypeConversion_gi; |
| 19401 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objUpdateFlag = |
| 19402 | fusionAlg_B.Switch_fy2; |
| 19403 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objValidFlag = |
| 19404 | fusionAlg_B.Switch_fy2; |
| 19405 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objType = |
| 19406 | fusionAlg_P_g.Constant9_Value_j1; |
| 19407 | fusionAlg_B.BusCreator_ad.radarObj.radar_35_obj.objMeasFlag = |
| 19408 | fusionAlg_P_g.Constant10_Value_dv; |
| 19409 | |
| 19410 | /* Selector: '<S139>/Selector35' incorporates: |
| 19411 | * Constant: '<S139>/Constant35' |
| 19412 | */ |
| 19413 | fusionAlg_B.Selector35_c = rtu_Radar308_Info_st-> |
| 19414 | rightRearRadar_General[fusionAlg_P_g.Constant35_Value_g]; |
| 19415 | |
| 19416 | /* DataTypeConversion: '<S170>/Data Type Conversion' */ |
| 19417 | tmp = (real32_T)floor(fusionAlg_B.Selector35_c.ID); |
| 19418 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19419 | tmp = 0.0F; |
| 19420 | } else { |
| 19421 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19422 | } |
| 19423 | |
| 19424 | fusionAlg_B.DataTypeConversion_eq = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 19425 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19426 | |
| 19427 | /* End of DataTypeConversion: '<S170>/Data Type Conversion' */ |
| 19428 | |
| 19429 | /* Switch: '<S170>/Switch' incorporates: |
| 19430 | * Constant: '<S170>/Constant7' |
| 19431 | * Constant: '<S170>/Constant8' |
| 19432 | */ |
| 19433 | if (fusionAlg_B.DataTypeConversion_eq > fusionAlg_P_g.Switch_Threshold_pu) { |
| 19434 | fusionAlg_B.Switch_dr = fusionAlg_P_g.Constant7_Value_l2; |
| 19435 | } else { |
| 19436 | fusionAlg_B.Switch_dr = fusionAlg_P_g.Constant8_Value_ip; |
| 19437 | } |
| 19438 | |
| 19439 | /* End of Switch: '<S170>/Switch' */ |
| 19440 | |
| 19441 | /* DataTypeConversion: '<S170>/Data Type Conversion1' */ |
| 19442 | tmp = (real32_T)floor(fusionAlg_B.Selector35_c.DynProp); |
| 19443 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19444 | tmp = 0.0F; |
| 19445 | } else { |
| 19446 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19447 | } |
| 19448 | |
| 19449 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objMotionPattern = (uint8_T) |
| 19450 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 19451 | tmp); |
| 19452 | |
| 19453 | /* End of DataTypeConversion: '<S170>/Data Type Conversion1' */ |
| 19454 | |
| 19455 | /* BusCreator: '<S170>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 19456 | * Constant: '<S170>/Constant' |
| 19457 | * Constant: '<S170>/Constant1' |
| 19458 | */ |
| 19459 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.reserved.reserved1 = |
| 19460 | fusionAlg_P_g.Constant_Value_lxh; |
| 19461 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.reserved.reserved0 = |
| 19462 | fusionAlg_P_g.Constant1_Value_ek; |
| 19463 | |
| 19464 | /* BusCreator: '<S170>/Bus Creator1' incorporates: |
| 19465 | * Constant: '<S170>/Constant10' |
| 19466 | * Constant: '<S170>/Constant2' |
| 19467 | * Constant: '<S170>/Constant3' |
| 19468 | * Constant: '<S170>/Constant4' |
| 19469 | * Constant: '<S170>/Constant5' |
| 19470 | * Constant: '<S170>/Constant6' |
| 19471 | * Constant: '<S170>/Constant9' |
| 19472 | */ |
| 19473 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objObstacleProb = |
| 19474 | fusionAlg_B.Selector35_c.RCS; |
| 19475 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objXPos_Stdev = |
| 19476 | fusionAlg_P_g.Constant2_Value_ao; |
| 19477 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objYPos_Stdev = |
| 19478 | fusionAlg_P_g.Constant3_Value_f4; |
| 19479 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objXVelRel_Stdev = |
| 19480 | fusionAlg_P_g.Constant4_Value_nn; |
| 19481 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objXAccRel = |
| 19482 | fusionAlg_P_g.Constant5_Value_ji; |
| 19483 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objExstProb = |
| 19484 | fusionAlg_P_g.Constant6_Value_ai; |
| 19485 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objYVelRel = |
| 19486 | fusionAlg_B.Selector35_c.VrelLat; |
| 19487 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objXVelRel = |
| 19488 | fusionAlg_B.Selector35_c.VrelLong; |
| 19489 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objXPos = |
| 19490 | fusionAlg_B.Selector35_c.DistLong; |
| 19491 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objYPos = |
| 19492 | fusionAlg_B.Selector35_c.DistLat; |
| 19493 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objID = |
| 19494 | fusionAlg_B.DataTypeConversion_eq; |
| 19495 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objUpdateFlag = |
| 19496 | fusionAlg_B.Switch_dr; |
| 19497 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objValidFlag = |
| 19498 | fusionAlg_B.Switch_dr; |
| 19499 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objType = |
| 19500 | fusionAlg_P_g.Constant9_Value_bd; |
| 19501 | fusionAlg_B.BusCreator_ad.radarObj.radar_36_obj.objMeasFlag = |
| 19502 | fusionAlg_P_g.Constant10_Value_hb; |
| 19503 | |
| 19504 | /* Selector: '<S139>/Selector36' incorporates: |
| 19505 | * Constant: '<S139>/Constant36' |
| 19506 | */ |
| 19507 | fusionAlg_B.Selector36_c = rtu_Radar308_Info_st-> |
| 19508 | rightRearRadar_General[fusionAlg_P_g.Constant36_Value_o]; |
| 19509 | |
| 19510 | /* DataTypeConversion: '<S171>/Data Type Conversion' */ |
| 19511 | tmp = (real32_T)floor(fusionAlg_B.Selector36_c.ID); |
| 19512 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19513 | tmp = 0.0F; |
| 19514 | } else { |
| 19515 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19516 | } |
| 19517 | |
| 19518 | fusionAlg_B.DataTypeConversion_jbw = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 19519 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19520 | |
| 19521 | /* End of DataTypeConversion: '<S171>/Data Type Conversion' */ |
| 19522 | |
| 19523 | /* Switch: '<S171>/Switch' incorporates: |
| 19524 | * Constant: '<S171>/Constant7' |
| 19525 | * Constant: '<S171>/Constant8' |
| 19526 | */ |
| 19527 | if (fusionAlg_B.DataTypeConversion_jbw > fusionAlg_P_g.Switch_Threshold_bb) { |
| 19528 | fusionAlg_B.Switch_k1d = fusionAlg_P_g.Constant7_Value_pt; |
| 19529 | } else { |
| 19530 | fusionAlg_B.Switch_k1d = fusionAlg_P_g.Constant8_Value_hs; |
| 19531 | } |
| 19532 | |
| 19533 | /* End of Switch: '<S171>/Switch' */ |
| 19534 | |
| 19535 | /* DataTypeConversion: '<S171>/Data Type Conversion1' */ |
| 19536 | tmp = (real32_T)floor(fusionAlg_B.Selector36_c.DynProp); |
| 19537 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19538 | tmp = 0.0F; |
| 19539 | } else { |
| 19540 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19541 | } |
| 19542 | |
| 19543 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objMotionPattern = (uint8_T) |
| 19544 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 19545 | tmp); |
| 19546 | |
| 19547 | /* End of DataTypeConversion: '<S171>/Data Type Conversion1' */ |
| 19548 | |
| 19549 | /* BusCreator: '<S171>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 19550 | * Constant: '<S171>/Constant' |
| 19551 | * Constant: '<S171>/Constant1' |
| 19552 | */ |
| 19553 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.reserved.reserved1 = |
| 19554 | fusionAlg_P_g.Constant_Value_gcb; |
| 19555 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.reserved.reserved0 = |
| 19556 | fusionAlg_P_g.Constant1_Value_gt; |
| 19557 | |
| 19558 | /* BusCreator: '<S171>/Bus Creator1' incorporates: |
| 19559 | * Constant: '<S171>/Constant10' |
| 19560 | * Constant: '<S171>/Constant2' |
| 19561 | * Constant: '<S171>/Constant3' |
| 19562 | * Constant: '<S171>/Constant4' |
| 19563 | * Constant: '<S171>/Constant5' |
| 19564 | * Constant: '<S171>/Constant6' |
| 19565 | * Constant: '<S171>/Constant9' |
| 19566 | */ |
| 19567 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objObstacleProb = |
| 19568 | fusionAlg_B.Selector36_c.RCS; |
| 19569 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objXPos_Stdev = |
| 19570 | fusionAlg_P_g.Constant2_Value_jz; |
| 19571 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objYPos_Stdev = |
| 19572 | fusionAlg_P_g.Constant3_Value_be; |
| 19573 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objXVelRel_Stdev = |
| 19574 | fusionAlg_P_g.Constant4_Value_g0; |
| 19575 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objXAccRel = |
| 19576 | fusionAlg_P_g.Constant5_Value_jb; |
| 19577 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objExstProb = |
| 19578 | fusionAlg_P_g.Constant6_Value_mf; |
| 19579 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objYVelRel = |
| 19580 | fusionAlg_B.Selector36_c.VrelLat; |
| 19581 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objXVelRel = |
| 19582 | fusionAlg_B.Selector36_c.VrelLong; |
| 19583 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objXPos = |
| 19584 | fusionAlg_B.Selector36_c.DistLong; |
| 19585 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objYPos = |
| 19586 | fusionAlg_B.Selector36_c.DistLat; |
| 19587 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objID = |
| 19588 | fusionAlg_B.DataTypeConversion_jbw; |
| 19589 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objUpdateFlag = |
| 19590 | fusionAlg_B.Switch_k1d; |
| 19591 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objValidFlag = |
| 19592 | fusionAlg_B.Switch_k1d; |
| 19593 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objType = |
| 19594 | fusionAlg_P_g.Constant9_Value_k1; |
| 19595 | fusionAlg_B.BusCreator_ad.radarObj.radar_37_obj.objMeasFlag = |
| 19596 | fusionAlg_P_g.Constant10_Value_l0; |
| 19597 | |
| 19598 | /* Selector: '<S139>/Selector37' incorporates: |
| 19599 | * Constant: '<S139>/Constant37' |
| 19600 | */ |
| 19601 | fusionAlg_B.Selector37_o = rtu_Radar308_Info_st-> |
| 19602 | rightRearRadar_General[fusionAlg_P_g.Constant37_Value_k]; |
| 19603 | |
| 19604 | /* DataTypeConversion: '<S172>/Data Type Conversion' */ |
| 19605 | tmp = (real32_T)floor(fusionAlg_B.Selector37_o.ID); |
| 19606 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19607 | tmp = 0.0F; |
| 19608 | } else { |
| 19609 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19610 | } |
| 19611 | |
| 19612 | fusionAlg_B.DataTypeConversion_b0c = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 19613 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19614 | |
| 19615 | /* End of DataTypeConversion: '<S172>/Data Type Conversion' */ |
| 19616 | |
| 19617 | /* Switch: '<S172>/Switch' incorporates: |
| 19618 | * Constant: '<S172>/Constant7' |
| 19619 | * Constant: '<S172>/Constant8' |
| 19620 | */ |
| 19621 | if (fusionAlg_B.DataTypeConversion_b0c > fusionAlg_P_g.Switch_Threshold_gz) { |
| 19622 | fusionAlg_B.Switch_al = fusionAlg_P_g.Constant7_Value_mx; |
| 19623 | } else { |
| 19624 | fusionAlg_B.Switch_al = fusionAlg_P_g.Constant8_Value_le; |
| 19625 | } |
| 19626 | |
| 19627 | /* End of Switch: '<S172>/Switch' */ |
| 19628 | |
| 19629 | /* DataTypeConversion: '<S172>/Data Type Conversion1' */ |
| 19630 | tmp = (real32_T)floor(fusionAlg_B.Selector37_o.DynProp); |
| 19631 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19632 | tmp = 0.0F; |
| 19633 | } else { |
| 19634 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19635 | } |
| 19636 | |
| 19637 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objMotionPattern = (uint8_T) |
| 19638 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 19639 | tmp); |
| 19640 | |
| 19641 | /* End of DataTypeConversion: '<S172>/Data Type Conversion1' */ |
| 19642 | |
| 19643 | /* BusCreator: '<S172>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 19644 | * Constant: '<S172>/Constant' |
| 19645 | * Constant: '<S172>/Constant1' |
| 19646 | */ |
| 19647 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.reserved.reserved1 = |
| 19648 | fusionAlg_P_g.Constant_Value_pv; |
| 19649 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.reserved.reserved0 = |
| 19650 | fusionAlg_P_g.Constant1_Value_n3; |
| 19651 | |
| 19652 | /* BusCreator: '<S172>/Bus Creator1' incorporates: |
| 19653 | * Constant: '<S172>/Constant10' |
| 19654 | * Constant: '<S172>/Constant2' |
| 19655 | * Constant: '<S172>/Constant3' |
| 19656 | * Constant: '<S172>/Constant4' |
| 19657 | * Constant: '<S172>/Constant5' |
| 19658 | * Constant: '<S172>/Constant6' |
| 19659 | * Constant: '<S172>/Constant9' |
| 19660 | */ |
| 19661 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objObstacleProb = |
| 19662 | fusionAlg_B.Selector37_o.RCS; |
| 19663 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objXPos_Stdev = |
| 19664 | fusionAlg_P_g.Constant2_Value_cln; |
| 19665 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objYPos_Stdev = |
| 19666 | fusionAlg_P_g.Constant3_Value_ou; |
| 19667 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objXVelRel_Stdev = |
| 19668 | fusionAlg_P_g.Constant4_Value_kl; |
| 19669 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objXAccRel = |
| 19670 | fusionAlg_P_g.Constant5_Value_el; |
| 19671 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objExstProb = |
| 19672 | fusionAlg_P_g.Constant6_Value_kfa; |
| 19673 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objYVelRel = |
| 19674 | fusionAlg_B.Selector37_o.VrelLat; |
| 19675 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objXVelRel = |
| 19676 | fusionAlg_B.Selector37_o.VrelLong; |
| 19677 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objXPos = |
| 19678 | fusionAlg_B.Selector37_o.DistLong; |
| 19679 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objYPos = |
| 19680 | fusionAlg_B.Selector37_o.DistLat; |
| 19681 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objID = |
| 19682 | fusionAlg_B.DataTypeConversion_b0c; |
| 19683 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objUpdateFlag = |
| 19684 | fusionAlg_B.Switch_al; |
| 19685 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objValidFlag = |
| 19686 | fusionAlg_B.Switch_al; |
| 19687 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objType = |
| 19688 | fusionAlg_P_g.Constant9_Value_ha; |
| 19689 | fusionAlg_B.BusCreator_ad.radarObj.radar_38_obj.objMeasFlag = |
| 19690 | fusionAlg_P_g.Constant10_Value_ku; |
| 19691 | |
| 19692 | /* Selector: '<S139>/Selector38' incorporates: |
| 19693 | * Constant: '<S139>/Constant38' |
| 19694 | */ |
| 19695 | fusionAlg_B.Selector38_f = rtu_Radar308_Info_st-> |
| 19696 | rightRearRadar_General[fusionAlg_P_g.Constant38_Value_k]; |
| 19697 | |
| 19698 | /* DataTypeConversion: '<S173>/Data Type Conversion' */ |
| 19699 | tmp = (real32_T)floor(fusionAlg_B.Selector38_f.ID); |
| 19700 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19701 | tmp = 0.0F; |
| 19702 | } else { |
| 19703 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19704 | } |
| 19705 | |
| 19706 | fusionAlg_B.DataTypeConversion_mw = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 19707 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19708 | |
| 19709 | /* End of DataTypeConversion: '<S173>/Data Type Conversion' */ |
| 19710 | |
| 19711 | /* Switch: '<S173>/Switch' incorporates: |
| 19712 | * Constant: '<S173>/Constant7' |
| 19713 | * Constant: '<S173>/Constant8' |
| 19714 | */ |
| 19715 | if (fusionAlg_B.DataTypeConversion_mw > fusionAlg_P_g.Switch_Threshold_g1) { |
| 19716 | fusionAlg_B.Switch_fw = fusionAlg_P_g.Constant7_Value_nx; |
| 19717 | } else { |
| 19718 | fusionAlg_B.Switch_fw = fusionAlg_P_g.Constant8_Value_cg; |
| 19719 | } |
| 19720 | |
| 19721 | /* End of Switch: '<S173>/Switch' */ |
| 19722 | |
| 19723 | /* DataTypeConversion: '<S173>/Data Type Conversion1' */ |
| 19724 | tmp = (real32_T)floor(fusionAlg_B.Selector38_f.DynProp); |
| 19725 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19726 | tmp = 0.0F; |
| 19727 | } else { |
| 19728 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19729 | } |
| 19730 | |
| 19731 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objMotionPattern = (uint8_T) |
| 19732 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 19733 | tmp); |
| 19734 | |
| 19735 | /* End of DataTypeConversion: '<S173>/Data Type Conversion1' */ |
| 19736 | |
| 19737 | /* BusCreator: '<S173>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 19738 | * Constant: '<S173>/Constant' |
| 19739 | * Constant: '<S173>/Constant1' |
| 19740 | */ |
| 19741 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.reserved.reserved1 = |
| 19742 | fusionAlg_P_g.Constant_Value_f1; |
| 19743 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.reserved.reserved0 = |
| 19744 | fusionAlg_P_g.Constant1_Value_is; |
| 19745 | |
| 19746 | /* BusCreator: '<S173>/Bus Creator1' incorporates: |
| 19747 | * Constant: '<S173>/Constant10' |
| 19748 | * Constant: '<S173>/Constant2' |
| 19749 | * Constant: '<S173>/Constant3' |
| 19750 | * Constant: '<S173>/Constant4' |
| 19751 | * Constant: '<S173>/Constant5' |
| 19752 | * Constant: '<S173>/Constant6' |
| 19753 | * Constant: '<S173>/Constant9' |
| 19754 | */ |
| 19755 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objObstacleProb = |
| 19756 | fusionAlg_B.Selector38_f.RCS; |
| 19757 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objXPos_Stdev = |
| 19758 | fusionAlg_P_g.Constant2_Value_eu; |
| 19759 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objYPos_Stdev = |
| 19760 | fusionAlg_P_g.Constant3_Value_ml; |
| 19761 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objXVelRel_Stdev = |
| 19762 | fusionAlg_P_g.Constant4_Value_nk; |
| 19763 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objXAccRel = |
| 19764 | fusionAlg_P_g.Constant5_Value_gz; |
| 19765 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objExstProb = |
| 19766 | fusionAlg_P_g.Constant6_Value_hd; |
| 19767 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objYVelRel = |
| 19768 | fusionAlg_B.Selector38_f.VrelLat; |
| 19769 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objXVelRel = |
| 19770 | fusionAlg_B.Selector38_f.VrelLong; |
| 19771 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objXPos = |
| 19772 | fusionAlg_B.Selector38_f.DistLong; |
| 19773 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objYPos = |
| 19774 | fusionAlg_B.Selector38_f.DistLat; |
| 19775 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objID = |
| 19776 | fusionAlg_B.DataTypeConversion_mw; |
| 19777 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objUpdateFlag = |
| 19778 | fusionAlg_B.Switch_fw; |
| 19779 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objValidFlag = |
| 19780 | fusionAlg_B.Switch_fw; |
| 19781 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objType = |
| 19782 | fusionAlg_P_g.Constant9_Value_dt; |
| 19783 | fusionAlg_B.BusCreator_ad.radarObj.radar_39_obj.objMeasFlag = |
| 19784 | fusionAlg_P_g.Constant10_Value_nn; |
| 19785 | |
| 19786 | /* Selector: '<S139>/Selector39' incorporates: |
| 19787 | * Constant: '<S139>/Constant39' |
| 19788 | */ |
| 19789 | fusionAlg_B.Selector39_mi = rtu_Radar308_Info_st-> |
| 19790 | rightRearRadar_General[fusionAlg_P_g.Constant39_Value_c]; |
| 19791 | |
| 19792 | /* DataTypeConversion: '<S175>/Data Type Conversion' */ |
| 19793 | tmp = (real32_T)floor(fusionAlg_B.Selector39_mi.ID); |
| 19794 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19795 | tmp = 0.0F; |
| 19796 | } else { |
| 19797 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19798 | } |
| 19799 | |
| 19800 | fusionAlg_B.DataTypeConversion_i4 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 19801 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19802 | |
| 19803 | /* End of DataTypeConversion: '<S175>/Data Type Conversion' */ |
| 19804 | |
| 19805 | /* Switch: '<S175>/Switch' incorporates: |
| 19806 | * Constant: '<S175>/Constant7' |
| 19807 | * Constant: '<S175>/Constant8' |
| 19808 | */ |
| 19809 | if (fusionAlg_B.DataTypeConversion_i4 > fusionAlg_P_g.Switch_Threshold_oyw) { |
| 19810 | fusionAlg_B.Switch_j3v = fusionAlg_P_g.Constant7_Value_jp; |
| 19811 | } else { |
| 19812 | fusionAlg_B.Switch_j3v = fusionAlg_P_g.Constant8_Value_cd; |
| 19813 | } |
| 19814 | |
| 19815 | /* End of Switch: '<S175>/Switch' */ |
| 19816 | |
| 19817 | /* DataTypeConversion: '<S175>/Data Type Conversion1' */ |
| 19818 | tmp = (real32_T)floor(fusionAlg_B.Selector39_mi.DynProp); |
| 19819 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19820 | tmp = 0.0F; |
| 19821 | } else { |
| 19822 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19823 | } |
| 19824 | |
| 19825 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objMotionPattern = (uint8_T) |
| 19826 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 19827 | tmp); |
| 19828 | |
| 19829 | /* End of DataTypeConversion: '<S175>/Data Type Conversion1' */ |
| 19830 | |
| 19831 | /* BusCreator: '<S175>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 19832 | * Constant: '<S175>/Constant' |
| 19833 | * Constant: '<S175>/Constant1' |
| 19834 | */ |
| 19835 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.reserved.reserved1 = |
| 19836 | fusionAlg_P_g.Constant_Value_mdo; |
| 19837 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.reserved.reserved0 = |
| 19838 | fusionAlg_P_g.Constant1_Value_f4z; |
| 19839 | |
| 19840 | /* BusCreator: '<S175>/Bus Creator1' incorporates: |
| 19841 | * Constant: '<S175>/Constant10' |
| 19842 | * Constant: '<S175>/Constant2' |
| 19843 | * Constant: '<S175>/Constant3' |
| 19844 | * Constant: '<S175>/Constant4' |
| 19845 | * Constant: '<S175>/Constant5' |
| 19846 | * Constant: '<S175>/Constant6' |
| 19847 | * Constant: '<S175>/Constant9' |
| 19848 | */ |
| 19849 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objObstacleProb = |
| 19850 | fusionAlg_B.Selector39_mi.RCS; |
| 19851 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objXPos_Stdev = |
| 19852 | fusionAlg_P_g.Constant2_Value_kt; |
| 19853 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objYPos_Stdev = |
| 19854 | fusionAlg_P_g.Constant3_Value_nr; |
| 19855 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objXVelRel_Stdev = |
| 19856 | fusionAlg_P_g.Constant4_Value_ic; |
| 19857 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objXAccRel = |
| 19858 | fusionAlg_P_g.Constant5_Value_ga2; |
| 19859 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objExstProb = |
| 19860 | fusionAlg_P_g.Constant6_Value_h1g; |
| 19861 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objYVelRel = |
| 19862 | fusionAlg_B.Selector39_mi.VrelLat; |
| 19863 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objXVelRel = |
| 19864 | fusionAlg_B.Selector39_mi.VrelLong; |
| 19865 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objXPos = |
| 19866 | fusionAlg_B.Selector39_mi.DistLong; |
| 19867 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objYPos = |
| 19868 | fusionAlg_B.Selector39_mi.DistLat; |
| 19869 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objID = |
| 19870 | fusionAlg_B.DataTypeConversion_i4; |
| 19871 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objUpdateFlag = |
| 19872 | fusionAlg_B.Switch_j3v; |
| 19873 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objValidFlag = |
| 19874 | fusionAlg_B.Switch_j3v; |
| 19875 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objType = |
| 19876 | fusionAlg_P_g.Constant9_Value_d5; |
| 19877 | fusionAlg_B.BusCreator_ad.radarObj.radar_40_obj.objMeasFlag = |
| 19878 | fusionAlg_P_g.Constant10_Value_bi; |
| 19879 | |
| 19880 | /* DataTypeConversion: '<S140>/Data Type Conversion' */ |
| 19881 | tmp = (real32_T)floor(rtu_Radar308_Info_st->rightRearRadar_Status.tStamp); |
| 19882 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19883 | tmp = 0.0F; |
| 19884 | } else { |
| 19885 | tmp = (real32_T)fmod(tmp, 256.0); |
| 19886 | } |
| 19887 | |
| 19888 | fusionAlg_B.BusCreator_ad.radarState.msgAliveCounter = (uint8_T)(tmp < 0.0F ? |
| 19889 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 19890 | |
| 19891 | /* End of DataTypeConversion: '<S140>/Data Type Conversion' */ |
| 19892 | |
| 19893 | /* BusCreator: '<S140>/Bus Creator2' incorporates: |
| 19894 | * Constant: '<S140>/Constant' |
| 19895 | * Constant: '<S140>/Constant1' |
| 19896 | */ |
| 19897 | fusionAlg_B.BusCreator_ad.radarState.reservedField.reserved1 = |
| 19898 | fusionAlg_P_g.Constant_Value_am2; |
| 19899 | fusionAlg_B.BusCreator_ad.radarState.reservedField.reserved0 = |
| 19900 | fusionAlg_P_g.Constant1_Value_ed; |
| 19901 | |
| 19902 | /* BusCreator: '<S140>/Bus Creator1' incorporates: |
| 19903 | * Constant: '<S140>/Constant10' |
| 19904 | * Constant: '<S140>/Constant11' |
| 19905 | * Constant: '<S140>/Constant2' |
| 19906 | * Constant: '<S140>/Constant3' |
| 19907 | * Constant: '<S140>/Constant4' |
| 19908 | * Constant: '<S140>/Constant5' |
| 19909 | * Constant: '<S140>/Constant6' |
| 19910 | * Constant: '<S140>/Constant7' |
| 19911 | * Constant: '<S140>/Constant8' |
| 19912 | * Constant: '<S140>/Constant9' |
| 19913 | */ |
| 19914 | fusionAlg_B.BusCreator_ad.radarState.hostYaw = |
| 19915 | fusionAlg_P_g.Constant2_Value_hiz; |
| 19916 | fusionAlg_B.BusCreator_ad.radarState.hostSpeed = |
| 19917 | fusionAlg_P_g.Constant3_Value_ha; |
| 19918 | fusionAlg_B.BusCreator_ad.radarState.timeStamp = |
| 19919 | fusionAlg_P_g.Constant4_Value_oy; |
| 19920 | fusionAlg_B.BusCreator_ad.radarState.statusHWErr = |
| 19921 | fusionAlg_P_g.Constant5_Value_o3j; |
| 19922 | fusionAlg_B.BusCreator_ad.radarState.statusBlkProg = |
| 19923 | fusionAlg_P_g.Constant6_Value_j4n; |
| 19924 | fusionAlg_B.BusCreator_ad.radarState.statusMisAlign = |
| 19925 | fusionAlg_P_g.Constant7_Value_hv; |
| 19926 | fusionAlg_B.BusCreator_ad.radarState.sGUFail = |
| 19927 | fusionAlg_P_g.Constant8_Value_n3; |
| 19928 | fusionAlg_B.BusCreator_ad.radarState.measEnabled = |
| 19929 | fusionAlg_P_g.Constant9_Value_pw; |
| 19930 | fusionAlg_B.BusCreator_ad.radarState.latency = |
| 19931 | fusionAlg_P_g.Constant10_Value_bp3; |
| 19932 | fusionAlg_B.BusCreator_ad.radarState.msgCheckSum = |
| 19933 | fusionAlg_P_g.Constant11_Value_p; |
| 19934 | |
| 19935 | /* BusCreator: '<S12>/Bus Creator1' incorporates: |
| 19936 | * Constant: '<S12>/Constant' |
| 19937 | * Constant: '<S12>/Constant1' |
| 19938 | */ |
| 19939 | fusionAlg_B.BusCreator_ad.reserved.reserved0 = fusionAlg_P_g.Constant_Value_gw; |
| 19940 | fusionAlg_B.BusCreator_ad.reserved.reserved1 = fusionAlg_P_g.Constant1_Value_d; |
| 19941 | |
| 19942 | /* BusCreator: '<S12>/Bus Creator' incorporates: |
| 19943 | * Constant: '<S12>/errType' |
| 19944 | * Constant: '<S12>/timestamp' |
| 19945 | */ |
| 19946 | fusionAlg_B.BusCreator_ad.timestamp = fusionAlg_P_g.timestamp_Value_l; |
| 19947 | fusionAlg_B.BusCreator_ad.errType = fusionAlg_P_g.errType_Value_g; |
| 19948 | |
| 19949 | /* DataTypeConversion: '<S10>/Data Type Conversion1' */ |
| 19950 | tmp = (real32_T)floor(rtu_Radar308_Info_st->leftRearRadar_Status.Version); |
| 19951 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19952 | tmp = 0.0F; |
| 19953 | } else { |
| 19954 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 19955 | } |
| 19956 | |
| 19957 | fusionAlg_B.BusCreator_o.frameNum = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 19958 | -tmp : (uint32_T)tmp; |
| 19959 | |
| 19960 | /* End of DataTypeConversion: '<S10>/Data Type Conversion1' */ |
| 19961 | |
| 19962 | /* DataTypeConversion: '<S10>/Data Type Conversion' */ |
| 19963 | tmp = (real32_T)floor(rtu_Radar308_Info_st->leftRearRadar_Status.ObjNum); |
| 19964 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19965 | tmp = 0.0F; |
| 19966 | } else { |
| 19967 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 19968 | } |
| 19969 | |
| 19970 | fusionAlg_B.BusCreator_o.count = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 19971 | -tmp : (uint32_T)tmp; |
| 19972 | |
| 19973 | /* End of DataTypeConversion: '<S10>/Data Type Conversion' */ |
| 19974 | |
| 19975 | /* Selector: '<S55>/Selector' incorporates: |
| 19976 | * Constant: '<S55>/Constant' |
| 19977 | */ |
| 19978 | fusionAlg_B.Selector_h = rtu_Radar308_Info_st-> |
| 19979 | leftRearRadar_General[fusionAlg_P_g.Constant_Value_f2]; |
| 19980 | |
| 19981 | /* DataTypeConversion: '<S57>/Data Type Conversion' */ |
| 19982 | tmp = (real32_T)floor(fusionAlg_B.Selector_h.ID); |
| 19983 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 19984 | tmp = 0.0F; |
| 19985 | } else { |
| 19986 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 19987 | } |
| 19988 | |
| 19989 | fusionAlg_B.DataTypeConversion_jz = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 19990 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 19991 | |
| 19992 | /* End of DataTypeConversion: '<S57>/Data Type Conversion' */ |
| 19993 | |
| 19994 | /* Switch: '<S57>/Switch' incorporates: |
| 19995 | * Constant: '<S57>/Constant7' |
| 19996 | * Constant: '<S57>/Constant8' |
| 19997 | */ |
| 19998 | if (fusionAlg_B.DataTypeConversion_jz > fusionAlg_P_g.Switch_Threshold_by) { |
| 19999 | fusionAlg_B.Switch_l1 = fusionAlg_P_g.Constant7_Value_dg; |
| 20000 | } else { |
| 20001 | fusionAlg_B.Switch_l1 = fusionAlg_P_g.Constant8_Value_cj; |
| 20002 | } |
| 20003 | |
| 20004 | /* End of Switch: '<S57>/Switch' */ |
| 20005 | |
| 20006 | /* DataTypeConversion: '<S57>/Data Type Conversion1' */ |
| 20007 | tmp = (real32_T)floor(fusionAlg_B.Selector_h.DynProp); |
| 20008 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20009 | tmp = 0.0F; |
| 20010 | } else { |
| 20011 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20012 | } |
| 20013 | |
| 20014 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objMotionPattern = (uint8_T) |
| 20015 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20016 | tmp); |
| 20017 | |
| 20018 | /* End of DataTypeConversion: '<S57>/Data Type Conversion1' */ |
| 20019 | |
| 20020 | /* BusCreator: '<S57>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20021 | * Constant: '<S57>/Constant' |
| 20022 | * Constant: '<S57>/Constant1' |
| 20023 | */ |
| 20024 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.reserved.reserved1 = |
| 20025 | fusionAlg_P_g.Constant_Value_nw; |
| 20026 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.reserved.reserved0 = |
| 20027 | fusionAlg_P_g.Constant1_Value_bf4; |
| 20028 | |
| 20029 | /* BusCreator: '<S57>/Bus Creator1' incorporates: |
| 20030 | * Constant: '<S57>/Constant10' |
| 20031 | * Constant: '<S57>/Constant2' |
| 20032 | * Constant: '<S57>/Constant3' |
| 20033 | * Constant: '<S57>/Constant4' |
| 20034 | * Constant: '<S57>/Constant5' |
| 20035 | * Constant: '<S57>/Constant6' |
| 20036 | * Constant: '<S57>/Constant9' |
| 20037 | */ |
| 20038 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objObstacleProb = |
| 20039 | fusionAlg_B.Selector_h.RCS; |
| 20040 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objXPos_Stdev = |
| 20041 | fusionAlg_P_g.Constant2_Value_kq; |
| 20042 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objYPos_Stdev = |
| 20043 | fusionAlg_P_g.Constant3_Value_lz; |
| 20044 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objXVelRel_Stdev = |
| 20045 | fusionAlg_P_g.Constant4_Value_fb; |
| 20046 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objXAccRel = |
| 20047 | fusionAlg_P_g.Constant5_Value_hf; |
| 20048 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objExstProb = |
| 20049 | fusionAlg_P_g.Constant6_Value_nqt; |
| 20050 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objYVelRel = |
| 20051 | fusionAlg_B.Selector_h.VrelLat; |
| 20052 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objXVelRel = |
| 20053 | fusionAlg_B.Selector_h.VrelLong; |
| 20054 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objXPos = |
| 20055 | fusionAlg_B.Selector_h.DistLong; |
| 20056 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objYPos = |
| 20057 | fusionAlg_B.Selector_h.DistLat; |
| 20058 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objID = |
| 20059 | fusionAlg_B.DataTypeConversion_jz; |
| 20060 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objUpdateFlag = |
| 20061 | fusionAlg_B.Switch_l1; |
| 20062 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objValidFlag = |
| 20063 | fusionAlg_B.Switch_l1; |
| 20064 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objType = |
| 20065 | fusionAlg_P_g.Constant9_Value_jf; |
| 20066 | fusionAlg_B.BusCreator_o.radarObj.radar_01_obj.objMeasFlag = |
| 20067 | fusionAlg_P_g.Constant10_Value_kf; |
| 20068 | |
| 20069 | /* Selector: '<S55>/Selector1' incorporates: |
| 20070 | * Constant: '<S55>/Constant1' |
| 20071 | */ |
| 20072 | fusionAlg_B.Selector1_g = rtu_Radar308_Info_st-> |
| 20073 | leftRearRadar_General[fusionAlg_P_g.Constant1_Value_bd]; |
| 20074 | |
| 20075 | /* DataTypeConversion: '<S68>/Data Type Conversion' */ |
| 20076 | tmp = (real32_T)floor(fusionAlg_B.Selector1_g.ID); |
| 20077 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20078 | tmp = 0.0F; |
| 20079 | } else { |
| 20080 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20081 | } |
| 20082 | |
| 20083 | fusionAlg_B.DataTypeConversion_o0 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 20084 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20085 | |
| 20086 | /* End of DataTypeConversion: '<S68>/Data Type Conversion' */ |
| 20087 | |
| 20088 | /* Switch: '<S68>/Switch' incorporates: |
| 20089 | * Constant: '<S68>/Constant7' |
| 20090 | * Constant: '<S68>/Constant8' |
| 20091 | */ |
| 20092 | if (fusionAlg_B.DataTypeConversion_o0 > fusionAlg_P_g.Switch_Threshold_pt) { |
| 20093 | fusionAlg_B.Switch_ha = fusionAlg_P_g.Constant7_Value_dsz; |
| 20094 | } else { |
| 20095 | fusionAlg_B.Switch_ha = fusionAlg_P_g.Constant8_Value_er; |
| 20096 | } |
| 20097 | |
| 20098 | /* End of Switch: '<S68>/Switch' */ |
| 20099 | |
| 20100 | /* DataTypeConversion: '<S68>/Data Type Conversion1' */ |
| 20101 | tmp = (real32_T)floor(fusionAlg_B.Selector1_g.DynProp); |
| 20102 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20103 | tmp = 0.0F; |
| 20104 | } else { |
| 20105 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20106 | } |
| 20107 | |
| 20108 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objMotionPattern = (uint8_T) |
| 20109 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20110 | tmp); |
| 20111 | |
| 20112 | /* End of DataTypeConversion: '<S68>/Data Type Conversion1' */ |
| 20113 | |
| 20114 | /* BusCreator: '<S68>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20115 | * Constant: '<S68>/Constant' |
| 20116 | * Constant: '<S68>/Constant1' |
| 20117 | */ |
| 20118 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.reserved.reserved1 = |
| 20119 | fusionAlg_P_g.Constant_Value_jql; |
| 20120 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.reserved.reserved0 = |
| 20121 | fusionAlg_P_g.Constant1_Value_o2z; |
| 20122 | |
| 20123 | /* BusCreator: '<S68>/Bus Creator1' incorporates: |
| 20124 | * Constant: '<S68>/Constant10' |
| 20125 | * Constant: '<S68>/Constant2' |
| 20126 | * Constant: '<S68>/Constant3' |
| 20127 | * Constant: '<S68>/Constant4' |
| 20128 | * Constant: '<S68>/Constant5' |
| 20129 | * Constant: '<S68>/Constant6' |
| 20130 | * Constant: '<S68>/Constant9' |
| 20131 | */ |
| 20132 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objObstacleProb = |
| 20133 | fusionAlg_B.Selector1_g.RCS; |
| 20134 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objXPos_Stdev = |
| 20135 | fusionAlg_P_g.Constant2_Value_gz; |
| 20136 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objYPos_Stdev = |
| 20137 | fusionAlg_P_g.Constant3_Value_m1a; |
| 20138 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objXVelRel_Stdev = |
| 20139 | fusionAlg_P_g.Constant4_Value_m5; |
| 20140 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objXAccRel = |
| 20141 | fusionAlg_P_g.Constant5_Value_kc; |
| 20142 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objExstProb = |
| 20143 | fusionAlg_P_g.Constant6_Value_ce; |
| 20144 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objYVelRel = |
| 20145 | fusionAlg_B.Selector1_g.VrelLat; |
| 20146 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objXVelRel = |
| 20147 | fusionAlg_B.Selector1_g.VrelLong; |
| 20148 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objXPos = |
| 20149 | fusionAlg_B.Selector1_g.DistLong; |
| 20150 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objYPos = |
| 20151 | fusionAlg_B.Selector1_g.DistLat; |
| 20152 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objID = |
| 20153 | fusionAlg_B.DataTypeConversion_o0; |
| 20154 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objUpdateFlag = |
| 20155 | fusionAlg_B.Switch_ha; |
| 20156 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objValidFlag = |
| 20157 | fusionAlg_B.Switch_ha; |
| 20158 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objType = |
| 20159 | fusionAlg_P_g.Constant9_Value_gst; |
| 20160 | fusionAlg_B.BusCreator_o.radarObj.radar_02_obj.objMeasFlag = |
| 20161 | fusionAlg_P_g.Constant10_Value_nv; |
| 20162 | |
| 20163 | /* Selector: '<S55>/Selector2' incorporates: |
| 20164 | * Constant: '<S55>/Constant2' |
| 20165 | */ |
| 20166 | fusionAlg_B.Selector2_dw = rtu_Radar308_Info_st-> |
| 20167 | leftRearRadar_General[fusionAlg_P_g.Constant2_Value_ad]; |
| 20168 | |
| 20169 | /* DataTypeConversion: '<S79>/Data Type Conversion' */ |
| 20170 | tmp = (real32_T)floor(fusionAlg_B.Selector2_dw.ID); |
| 20171 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20172 | tmp = 0.0F; |
| 20173 | } else { |
| 20174 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20175 | } |
| 20176 | |
| 20177 | fusionAlg_B.DataTypeConversion_c3 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 20178 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20179 | |
| 20180 | /* End of DataTypeConversion: '<S79>/Data Type Conversion' */ |
| 20181 | |
| 20182 | /* Switch: '<S79>/Switch' incorporates: |
| 20183 | * Constant: '<S79>/Constant7' |
| 20184 | * Constant: '<S79>/Constant8' |
| 20185 | */ |
| 20186 | if (fusionAlg_B.DataTypeConversion_c3 > fusionAlg_P_g.Switch_Threshold_jg) { |
| 20187 | fusionAlg_B.Switch_h2 = fusionAlg_P_g.Constant7_Value_cr; |
| 20188 | } else { |
| 20189 | fusionAlg_B.Switch_h2 = fusionAlg_P_g.Constant8_Value_nb; |
| 20190 | } |
| 20191 | |
| 20192 | /* End of Switch: '<S79>/Switch' */ |
| 20193 | |
| 20194 | /* DataTypeConversion: '<S79>/Data Type Conversion1' */ |
| 20195 | tmp = (real32_T)floor(fusionAlg_B.Selector2_dw.DynProp); |
| 20196 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20197 | tmp = 0.0F; |
| 20198 | } else { |
| 20199 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20200 | } |
| 20201 | |
| 20202 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objMotionPattern = (uint8_T) |
| 20203 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20204 | tmp); |
| 20205 | |
| 20206 | /* End of DataTypeConversion: '<S79>/Data Type Conversion1' */ |
| 20207 | |
| 20208 | /* BusCreator: '<S79>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20209 | * Constant: '<S79>/Constant' |
| 20210 | * Constant: '<S79>/Constant1' |
| 20211 | */ |
| 20212 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.reserved.reserved1 = |
| 20213 | fusionAlg_P_g.Constant_Value_n5s; |
| 20214 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.reserved.reserved0 = |
| 20215 | fusionAlg_P_g.Constant1_Value_gv; |
| 20216 | |
| 20217 | /* BusCreator: '<S79>/Bus Creator1' incorporates: |
| 20218 | * Constant: '<S79>/Constant10' |
| 20219 | * Constant: '<S79>/Constant2' |
| 20220 | * Constant: '<S79>/Constant3' |
| 20221 | * Constant: '<S79>/Constant4' |
| 20222 | * Constant: '<S79>/Constant5' |
| 20223 | * Constant: '<S79>/Constant6' |
| 20224 | * Constant: '<S79>/Constant9' |
| 20225 | */ |
| 20226 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objObstacleProb = |
| 20227 | fusionAlg_B.Selector2_dw.RCS; |
| 20228 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objXPos_Stdev = |
| 20229 | fusionAlg_P_g.Constant2_Value_nu; |
| 20230 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objYPos_Stdev = |
| 20231 | fusionAlg_P_g.Constant3_Value_pdd; |
| 20232 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objXVelRel_Stdev = |
| 20233 | fusionAlg_P_g.Constant4_Value_jv; |
| 20234 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objXAccRel = |
| 20235 | fusionAlg_P_g.Constant5_Value_lr; |
| 20236 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objExstProb = |
| 20237 | fusionAlg_P_g.Constant6_Value_a4; |
| 20238 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objYVelRel = |
| 20239 | fusionAlg_B.Selector2_dw.VrelLat; |
| 20240 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objXVelRel = |
| 20241 | fusionAlg_B.Selector2_dw.VrelLong; |
| 20242 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objXPos = |
| 20243 | fusionAlg_B.Selector2_dw.DistLong; |
| 20244 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objYPos = |
| 20245 | fusionAlg_B.Selector2_dw.DistLat; |
| 20246 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objID = |
| 20247 | fusionAlg_B.DataTypeConversion_c3; |
| 20248 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objUpdateFlag = |
| 20249 | fusionAlg_B.Switch_h2; |
| 20250 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objValidFlag = |
| 20251 | fusionAlg_B.Switch_h2; |
| 20252 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objType = |
| 20253 | fusionAlg_P_g.Constant9_Value_ow; |
| 20254 | fusionAlg_B.BusCreator_o.radarObj.radar_03_obj.objMeasFlag = |
| 20255 | fusionAlg_P_g.Constant10_Value_dc; |
| 20256 | |
| 20257 | /* Selector: '<S55>/Selector3' incorporates: |
| 20258 | * Constant: '<S55>/Constant3' |
| 20259 | */ |
| 20260 | fusionAlg_B.Selector3_g = rtu_Radar308_Info_st-> |
| 20261 | leftRearRadar_General[fusionAlg_P_g.Constant3_Value_ovc]; |
| 20262 | |
| 20263 | /* DataTypeConversion: '<S90>/Data Type Conversion' */ |
| 20264 | tmp = (real32_T)floor(fusionAlg_B.Selector3_g.ID); |
| 20265 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20266 | tmp = 0.0F; |
| 20267 | } else { |
| 20268 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20269 | } |
| 20270 | |
| 20271 | fusionAlg_B.DataTypeConversion_gy = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 20272 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20273 | |
| 20274 | /* End of DataTypeConversion: '<S90>/Data Type Conversion' */ |
| 20275 | |
| 20276 | /* Switch: '<S90>/Switch' incorporates: |
| 20277 | * Constant: '<S90>/Constant7' |
| 20278 | * Constant: '<S90>/Constant8' |
| 20279 | */ |
| 20280 | if (fusionAlg_B.DataTypeConversion_gy > fusionAlg_P_g.Switch_Threshold_gh) { |
| 20281 | fusionAlg_B.Switch_jy = fusionAlg_P_g.Constant7_Value_jm; |
| 20282 | } else { |
| 20283 | fusionAlg_B.Switch_jy = fusionAlg_P_g.Constant8_Value_ch; |
| 20284 | } |
| 20285 | |
| 20286 | /* End of Switch: '<S90>/Switch' */ |
| 20287 | |
| 20288 | /* DataTypeConversion: '<S90>/Data Type Conversion1' */ |
| 20289 | tmp = (real32_T)floor(fusionAlg_B.Selector3_g.DynProp); |
| 20290 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20291 | tmp = 0.0F; |
| 20292 | } else { |
| 20293 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20294 | } |
| 20295 | |
| 20296 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objMotionPattern = (uint8_T) |
| 20297 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20298 | tmp); |
| 20299 | |
| 20300 | /* End of DataTypeConversion: '<S90>/Data Type Conversion1' */ |
| 20301 | |
| 20302 | /* BusCreator: '<S90>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20303 | * Constant: '<S90>/Constant' |
| 20304 | * Constant: '<S90>/Constant1' |
| 20305 | */ |
| 20306 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.reserved.reserved1 = |
| 20307 | fusionAlg_P_g.Constant_Value_nh; |
| 20308 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.reserved.reserved0 = |
| 20309 | fusionAlg_P_g.Constant1_Value_mn; |
| 20310 | |
| 20311 | /* BusCreator: '<S90>/Bus Creator1' incorporates: |
| 20312 | * Constant: '<S90>/Constant10' |
| 20313 | * Constant: '<S90>/Constant2' |
| 20314 | * Constant: '<S90>/Constant3' |
| 20315 | * Constant: '<S90>/Constant4' |
| 20316 | * Constant: '<S90>/Constant5' |
| 20317 | * Constant: '<S90>/Constant6' |
| 20318 | * Constant: '<S90>/Constant9' |
| 20319 | */ |
| 20320 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objObstacleProb = |
| 20321 | fusionAlg_B.Selector3_g.RCS; |
| 20322 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objXPos_Stdev = |
| 20323 | fusionAlg_P_g.Constant2_Value_ir; |
| 20324 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objYPos_Stdev = |
| 20325 | fusionAlg_P_g.Constant3_Value_enz; |
| 20326 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objXVelRel_Stdev = |
| 20327 | fusionAlg_P_g.Constant4_Value_no; |
| 20328 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objXAccRel = |
| 20329 | fusionAlg_P_g.Constant5_Value_hx; |
| 20330 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objExstProb = |
| 20331 | fusionAlg_P_g.Constant6_Value_fsi; |
| 20332 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objYVelRel = |
| 20333 | fusionAlg_B.Selector3_g.VrelLat; |
| 20334 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objXVelRel = |
| 20335 | fusionAlg_B.Selector3_g.VrelLong; |
| 20336 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objXPos = |
| 20337 | fusionAlg_B.Selector3_g.DistLong; |
| 20338 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objYPos = |
| 20339 | fusionAlg_B.Selector3_g.DistLat; |
| 20340 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objID = |
| 20341 | fusionAlg_B.DataTypeConversion_gy; |
| 20342 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objUpdateFlag = |
| 20343 | fusionAlg_B.Switch_jy; |
| 20344 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objValidFlag = |
| 20345 | fusionAlg_B.Switch_jy; |
| 20346 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objType = |
| 20347 | fusionAlg_P_g.Constant9_Value_ku; |
| 20348 | fusionAlg_B.BusCreator_o.radarObj.radar_04_obj.objMeasFlag = |
| 20349 | fusionAlg_P_g.Constant10_Value_dz; |
| 20350 | |
| 20351 | /* Selector: '<S55>/Selector4' incorporates: |
| 20352 | * Constant: '<S55>/Constant4' |
| 20353 | */ |
| 20354 | fusionAlg_B.Selector4_g = rtu_Radar308_Info_st-> |
| 20355 | leftRearRadar_General[fusionAlg_P_g.Constant4_Value_nj]; |
| 20356 | |
| 20357 | /* DataTypeConversion: '<S92>/Data Type Conversion' */ |
| 20358 | tmp = (real32_T)floor(fusionAlg_B.Selector4_g.ID); |
| 20359 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20360 | tmp = 0.0F; |
| 20361 | } else { |
| 20362 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20363 | } |
| 20364 | |
| 20365 | fusionAlg_B.DataTypeConversion_pck = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 20366 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20367 | |
| 20368 | /* End of DataTypeConversion: '<S92>/Data Type Conversion' */ |
| 20369 | |
| 20370 | /* Switch: '<S92>/Switch' incorporates: |
| 20371 | * Constant: '<S92>/Constant7' |
| 20372 | * Constant: '<S92>/Constant8' |
| 20373 | */ |
| 20374 | if (fusionAlg_B.DataTypeConversion_pck > fusionAlg_P_g.Switch_Threshold_anf) { |
| 20375 | fusionAlg_B.Switch_gk = fusionAlg_P_g.Constant7_Value_l5g; |
| 20376 | } else { |
| 20377 | fusionAlg_B.Switch_gk = fusionAlg_P_g.Constant8_Value_nq; |
| 20378 | } |
| 20379 | |
| 20380 | /* End of Switch: '<S92>/Switch' */ |
| 20381 | |
| 20382 | /* DataTypeConversion: '<S92>/Data Type Conversion1' */ |
| 20383 | tmp = (real32_T)floor(fusionAlg_B.Selector4_g.DynProp); |
| 20384 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20385 | tmp = 0.0F; |
| 20386 | } else { |
| 20387 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20388 | } |
| 20389 | |
| 20390 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objMotionPattern = (uint8_T) |
| 20391 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20392 | tmp); |
| 20393 | |
| 20394 | /* End of DataTypeConversion: '<S92>/Data Type Conversion1' */ |
| 20395 | |
| 20396 | /* BusCreator: '<S92>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20397 | * Constant: '<S92>/Constant' |
| 20398 | * Constant: '<S92>/Constant1' |
| 20399 | */ |
| 20400 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.reserved.reserved1 = |
| 20401 | fusionAlg_P_g.Constant_Value_i2; |
| 20402 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.reserved.reserved0 = |
| 20403 | fusionAlg_P_g.Constant1_Value_gz; |
| 20404 | |
| 20405 | /* BusCreator: '<S92>/Bus Creator1' incorporates: |
| 20406 | * Constant: '<S92>/Constant10' |
| 20407 | * Constant: '<S92>/Constant2' |
| 20408 | * Constant: '<S92>/Constant3' |
| 20409 | * Constant: '<S92>/Constant4' |
| 20410 | * Constant: '<S92>/Constant5' |
| 20411 | * Constant: '<S92>/Constant6' |
| 20412 | * Constant: '<S92>/Constant9' |
| 20413 | */ |
| 20414 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objObstacleProb = |
| 20415 | fusionAlg_B.Selector4_g.RCS; |
| 20416 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objXPos_Stdev = |
| 20417 | fusionAlg_P_g.Constant2_Value_h4; |
| 20418 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objYPos_Stdev = |
| 20419 | fusionAlg_P_g.Constant3_Value_pb; |
| 20420 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objXVelRel_Stdev = |
| 20421 | fusionAlg_P_g.Constant4_Value_gw4; |
| 20422 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objXAccRel = |
| 20423 | fusionAlg_P_g.Constant5_Value_m0; |
| 20424 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objExstProb = |
| 20425 | fusionAlg_P_g.Constant6_Value_gg; |
| 20426 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objYVelRel = |
| 20427 | fusionAlg_B.Selector4_g.VrelLat; |
| 20428 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objXVelRel = |
| 20429 | fusionAlg_B.Selector4_g.VrelLong; |
| 20430 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objXPos = |
| 20431 | fusionAlg_B.Selector4_g.DistLong; |
| 20432 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objYPos = |
| 20433 | fusionAlg_B.Selector4_g.DistLat; |
| 20434 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objID = |
| 20435 | fusionAlg_B.DataTypeConversion_pck; |
| 20436 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objUpdateFlag = |
| 20437 | fusionAlg_B.Switch_gk; |
| 20438 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objValidFlag = |
| 20439 | fusionAlg_B.Switch_gk; |
| 20440 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objType = |
| 20441 | fusionAlg_P_g.Constant9_Value_it; |
| 20442 | fusionAlg_B.BusCreator_o.radarObj.radar_05_obj.objMeasFlag = |
| 20443 | fusionAlg_P_g.Constant10_Value_gu; |
| 20444 | |
| 20445 | /* Selector: '<S55>/Selector5' incorporates: |
| 20446 | * Constant: '<S55>/Constant5' |
| 20447 | */ |
| 20448 | fusionAlg_B.Selector5_p = rtu_Radar308_Info_st-> |
| 20449 | leftRearRadar_General[fusionAlg_P_g.Constant5_Value_n4]; |
| 20450 | |
| 20451 | /* DataTypeConversion: '<S93>/Data Type Conversion' */ |
| 20452 | tmp = (real32_T)floor(fusionAlg_B.Selector5_p.ID); |
| 20453 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20454 | tmp = 0.0F; |
| 20455 | } else { |
| 20456 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20457 | } |
| 20458 | |
| 20459 | fusionAlg_B.DataTypeConversion_j1k = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 20460 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20461 | |
| 20462 | /* End of DataTypeConversion: '<S93>/Data Type Conversion' */ |
| 20463 | |
| 20464 | /* Switch: '<S93>/Switch' incorporates: |
| 20465 | * Constant: '<S93>/Constant7' |
| 20466 | * Constant: '<S93>/Constant8' |
| 20467 | */ |
| 20468 | if (fusionAlg_B.DataTypeConversion_j1k > fusionAlg_P_g.Switch_Threshold_oz) { |
| 20469 | fusionAlg_B.Switch_kg = fusionAlg_P_g.Constant7_Value_gb; |
| 20470 | } else { |
| 20471 | fusionAlg_B.Switch_kg = fusionAlg_P_g.Constant8_Value_fo4; |
| 20472 | } |
| 20473 | |
| 20474 | /* End of Switch: '<S93>/Switch' */ |
| 20475 | |
| 20476 | /* DataTypeConversion: '<S93>/Data Type Conversion1' */ |
| 20477 | tmp = (real32_T)floor(fusionAlg_B.Selector5_p.DynProp); |
| 20478 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20479 | tmp = 0.0F; |
| 20480 | } else { |
| 20481 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20482 | } |
| 20483 | |
| 20484 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objMotionPattern = (uint8_T) |
| 20485 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20486 | tmp); |
| 20487 | |
| 20488 | /* End of DataTypeConversion: '<S93>/Data Type Conversion1' */ |
| 20489 | |
| 20490 | /* BusCreator: '<S93>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20491 | * Constant: '<S93>/Constant' |
| 20492 | * Constant: '<S93>/Constant1' |
| 20493 | */ |
| 20494 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.reserved.reserved1 = |
| 20495 | fusionAlg_P_g.Constant_Value_obx; |
| 20496 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.reserved.reserved0 = |
| 20497 | fusionAlg_P_g.Constant1_Value_ho; |
| 20498 | |
| 20499 | /* BusCreator: '<S93>/Bus Creator1' incorporates: |
| 20500 | * Constant: '<S93>/Constant10' |
| 20501 | * Constant: '<S93>/Constant2' |
| 20502 | * Constant: '<S93>/Constant3' |
| 20503 | * Constant: '<S93>/Constant4' |
| 20504 | * Constant: '<S93>/Constant5' |
| 20505 | * Constant: '<S93>/Constant6' |
| 20506 | * Constant: '<S93>/Constant9' |
| 20507 | */ |
| 20508 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objObstacleProb = |
| 20509 | fusionAlg_B.Selector5_p.RCS; |
| 20510 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objXPos_Stdev = |
| 20511 | fusionAlg_P_g.Constant2_Value_iq; |
| 20512 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objYPos_Stdev = |
| 20513 | fusionAlg_P_g.Constant3_Value_jf; |
| 20514 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objXVelRel_Stdev = |
| 20515 | fusionAlg_P_g.Constant4_Value_nd; |
| 20516 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objXAccRel = |
| 20517 | fusionAlg_P_g.Constant5_Value_da; |
| 20518 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objExstProb = |
| 20519 | fusionAlg_P_g.Constant6_Value_mh; |
| 20520 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objYVelRel = |
| 20521 | fusionAlg_B.Selector5_p.VrelLat; |
| 20522 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objXVelRel = |
| 20523 | fusionAlg_B.Selector5_p.VrelLong; |
| 20524 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objXPos = |
| 20525 | fusionAlg_B.Selector5_p.DistLong; |
| 20526 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objYPos = |
| 20527 | fusionAlg_B.Selector5_p.DistLat; |
| 20528 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objID = |
| 20529 | fusionAlg_B.DataTypeConversion_j1k; |
| 20530 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objUpdateFlag = |
| 20531 | fusionAlg_B.Switch_kg; |
| 20532 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objValidFlag = |
| 20533 | fusionAlg_B.Switch_kg; |
| 20534 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objType = |
| 20535 | fusionAlg_P_g.Constant9_Value_ij; |
| 20536 | fusionAlg_B.BusCreator_o.radarObj.radar_06_obj.objMeasFlag = |
| 20537 | fusionAlg_P_g.Constant10_Value_lf; |
| 20538 | |
| 20539 | /* Selector: '<S55>/Selector6' incorporates: |
| 20540 | * Constant: '<S55>/Constant6' |
| 20541 | */ |
| 20542 | fusionAlg_B.Selector6_lq = rtu_Radar308_Info_st-> |
| 20543 | leftRearRadar_General[fusionAlg_P_g.Constant6_Value_mf2]; |
| 20544 | |
| 20545 | /* DataTypeConversion: '<S94>/Data Type Conversion' */ |
| 20546 | tmp = (real32_T)floor(fusionAlg_B.Selector6_lq.ID); |
| 20547 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20548 | tmp = 0.0F; |
| 20549 | } else { |
| 20550 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20551 | } |
| 20552 | |
| 20553 | fusionAlg_B.DataTypeConversion_dx = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 20554 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20555 | |
| 20556 | /* End of DataTypeConversion: '<S94>/Data Type Conversion' */ |
| 20557 | |
| 20558 | /* Switch: '<S94>/Switch' incorporates: |
| 20559 | * Constant: '<S94>/Constant7' |
| 20560 | * Constant: '<S94>/Constant8' |
| 20561 | */ |
| 20562 | if (fusionAlg_B.DataTypeConversion_dx > fusionAlg_P_g.Switch_Threshold_oyu) { |
| 20563 | fusionAlg_B.Switch_cg = fusionAlg_P_g.Constant7_Value_o1; |
| 20564 | } else { |
| 20565 | fusionAlg_B.Switch_cg = fusionAlg_P_g.Constant8_Value_cy3; |
| 20566 | } |
| 20567 | |
| 20568 | /* End of Switch: '<S94>/Switch' */ |
| 20569 | |
| 20570 | /* DataTypeConversion: '<S94>/Data Type Conversion1' */ |
| 20571 | tmp = (real32_T)floor(fusionAlg_B.Selector6_lq.DynProp); |
| 20572 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20573 | tmp = 0.0F; |
| 20574 | } else { |
| 20575 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20576 | } |
| 20577 | |
| 20578 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objMotionPattern = (uint8_T) |
| 20579 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20580 | tmp); |
| 20581 | |
| 20582 | /* End of DataTypeConversion: '<S94>/Data Type Conversion1' */ |
| 20583 | |
| 20584 | /* BusCreator: '<S94>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20585 | * Constant: '<S94>/Constant' |
| 20586 | * Constant: '<S94>/Constant1' |
| 20587 | */ |
| 20588 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.reserved.reserved1 = |
| 20589 | fusionAlg_P_g.Constant_Value_aan; |
| 20590 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.reserved.reserved0 = |
| 20591 | fusionAlg_P_g.Constant1_Value_ct; |
| 20592 | |
| 20593 | /* BusCreator: '<S94>/Bus Creator1' incorporates: |
| 20594 | * Constant: '<S94>/Constant10' |
| 20595 | * Constant: '<S94>/Constant2' |
| 20596 | * Constant: '<S94>/Constant3' |
| 20597 | * Constant: '<S94>/Constant4' |
| 20598 | * Constant: '<S94>/Constant5' |
| 20599 | * Constant: '<S94>/Constant6' |
| 20600 | * Constant: '<S94>/Constant9' |
| 20601 | */ |
| 20602 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objObstacleProb = |
| 20603 | fusionAlg_B.Selector6_lq.RCS; |
| 20604 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objXPos_Stdev = |
| 20605 | fusionAlg_P_g.Constant2_Value_n4; |
| 20606 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objYPos_Stdev = |
| 20607 | fusionAlg_P_g.Constant3_Value_ow; |
| 20608 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objXVelRel_Stdev = |
| 20609 | fusionAlg_P_g.Constant4_Value_md; |
| 20610 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objXAccRel = |
| 20611 | fusionAlg_P_g.Constant5_Value_a0; |
| 20612 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objExstProb = |
| 20613 | fusionAlg_P_g.Constant6_Value_ns; |
| 20614 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objYVelRel = |
| 20615 | fusionAlg_B.Selector6_lq.VrelLat; |
| 20616 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objXVelRel = |
| 20617 | fusionAlg_B.Selector6_lq.VrelLong; |
| 20618 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objXPos = |
| 20619 | fusionAlg_B.Selector6_lq.DistLong; |
| 20620 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objYPos = |
| 20621 | fusionAlg_B.Selector6_lq.DistLat; |
| 20622 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objID = |
| 20623 | fusionAlg_B.DataTypeConversion_dx; |
| 20624 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objUpdateFlag = |
| 20625 | fusionAlg_B.Switch_cg; |
| 20626 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objValidFlag = |
| 20627 | fusionAlg_B.Switch_cg; |
| 20628 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objType = |
| 20629 | fusionAlg_P_g.Constant9_Value_hm; |
| 20630 | fusionAlg_B.BusCreator_o.radarObj.radar_07_obj.objMeasFlag = |
| 20631 | fusionAlg_P_g.Constant10_Value_ck; |
| 20632 | |
| 20633 | /* Selector: '<S55>/Selector7' incorporates: |
| 20634 | * Constant: '<S55>/Constant7' |
| 20635 | */ |
| 20636 | fusionAlg_B.Selector7_i = rtu_Radar308_Info_st-> |
| 20637 | leftRearRadar_General[fusionAlg_P_g.Constant7_Value_ku]; |
| 20638 | |
| 20639 | /* DataTypeConversion: '<S95>/Data Type Conversion' */ |
| 20640 | tmp = (real32_T)floor(fusionAlg_B.Selector7_i.ID); |
| 20641 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20642 | tmp = 0.0F; |
| 20643 | } else { |
| 20644 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20645 | } |
| 20646 | |
| 20647 | fusionAlg_B.DataTypeConversion_cn = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 20648 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20649 | |
| 20650 | /* End of DataTypeConversion: '<S95>/Data Type Conversion' */ |
| 20651 | |
| 20652 | /* Switch: '<S95>/Switch' incorporates: |
| 20653 | * Constant: '<S95>/Constant7' |
| 20654 | * Constant: '<S95>/Constant8' |
| 20655 | */ |
| 20656 | if (fusionAlg_B.DataTypeConversion_cn > fusionAlg_P_g.Switch_Threshold_lp) { |
| 20657 | fusionAlg_B.Switch_o4 = fusionAlg_P_g.Constant7_Value_gav; |
| 20658 | } else { |
| 20659 | fusionAlg_B.Switch_o4 = fusionAlg_P_g.Constant8_Value_ad; |
| 20660 | } |
| 20661 | |
| 20662 | /* End of Switch: '<S95>/Switch' */ |
| 20663 | |
| 20664 | /* DataTypeConversion: '<S95>/Data Type Conversion1' */ |
| 20665 | tmp = (real32_T)floor(fusionAlg_B.Selector7_i.DynProp); |
| 20666 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20667 | tmp = 0.0F; |
| 20668 | } else { |
| 20669 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20670 | } |
| 20671 | |
| 20672 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objMotionPattern = (uint8_T) |
| 20673 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20674 | tmp); |
| 20675 | |
| 20676 | /* End of DataTypeConversion: '<S95>/Data Type Conversion1' */ |
| 20677 | |
| 20678 | /* BusCreator: '<S95>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20679 | * Constant: '<S95>/Constant' |
| 20680 | * Constant: '<S95>/Constant1' |
| 20681 | */ |
| 20682 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.reserved.reserved1 = |
| 20683 | fusionAlg_P_g.Constant_Value_nz; |
| 20684 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.reserved.reserved0 = |
| 20685 | fusionAlg_P_g.Constant1_Value_kt; |
| 20686 | |
| 20687 | /* BusCreator: '<S95>/Bus Creator1' incorporates: |
| 20688 | * Constant: '<S95>/Constant10' |
| 20689 | * Constant: '<S95>/Constant2' |
| 20690 | * Constant: '<S95>/Constant3' |
| 20691 | * Constant: '<S95>/Constant4' |
| 20692 | * Constant: '<S95>/Constant5' |
| 20693 | * Constant: '<S95>/Constant6' |
| 20694 | * Constant: '<S95>/Constant9' |
| 20695 | */ |
| 20696 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objObstacleProb = |
| 20697 | fusionAlg_B.Selector7_i.RCS; |
| 20698 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objXPos_Stdev = |
| 20699 | fusionAlg_P_g.Constant2_Value_it; |
| 20700 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objYPos_Stdev = |
| 20701 | fusionAlg_P_g.Constant3_Value_nq; |
| 20702 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objXVelRel_Stdev = |
| 20703 | fusionAlg_P_g.Constant4_Value_fg; |
| 20704 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objXAccRel = |
| 20705 | fusionAlg_P_g.Constant5_Value_ch; |
| 20706 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objExstProb = |
| 20707 | fusionAlg_P_g.Constant6_Value_ao; |
| 20708 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objYVelRel = |
| 20709 | fusionAlg_B.Selector7_i.VrelLat; |
| 20710 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objXVelRel = |
| 20711 | fusionAlg_B.Selector7_i.VrelLong; |
| 20712 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objXPos = |
| 20713 | fusionAlg_B.Selector7_i.DistLong; |
| 20714 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objYPos = |
| 20715 | fusionAlg_B.Selector7_i.DistLat; |
| 20716 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objID = |
| 20717 | fusionAlg_B.DataTypeConversion_cn; |
| 20718 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objUpdateFlag = |
| 20719 | fusionAlg_B.Switch_o4; |
| 20720 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objValidFlag = |
| 20721 | fusionAlg_B.Switch_o4; |
| 20722 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objType = |
| 20723 | fusionAlg_P_g.Constant9_Value_lal; |
| 20724 | fusionAlg_B.BusCreator_o.radarObj.radar_08_obj.objMeasFlag = |
| 20725 | fusionAlg_P_g.Constant10_Value_hv4; |
| 20726 | |
| 20727 | /* Selector: '<S55>/Selector8' incorporates: |
| 20728 | * Constant: '<S55>/Constant8' |
| 20729 | */ |
| 20730 | fusionAlg_B.Selector8_a = rtu_Radar308_Info_st-> |
| 20731 | leftRearRadar_General[fusionAlg_P_g.Constant8_Value_iv]; |
| 20732 | |
| 20733 | /* DataTypeConversion: '<S96>/Data Type Conversion' */ |
| 20734 | tmp = (real32_T)floor(fusionAlg_B.Selector8_a.ID); |
| 20735 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20736 | tmp = 0.0F; |
| 20737 | } else { |
| 20738 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20739 | } |
| 20740 | |
| 20741 | fusionAlg_B.DataTypeConversion_je = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 20742 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20743 | |
| 20744 | /* End of DataTypeConversion: '<S96>/Data Type Conversion' */ |
| 20745 | |
| 20746 | /* Switch: '<S96>/Switch' incorporates: |
| 20747 | * Constant: '<S96>/Constant7' |
| 20748 | * Constant: '<S96>/Constant8' |
| 20749 | */ |
| 20750 | if (fusionAlg_B.DataTypeConversion_je > fusionAlg_P_g.Switch_Threshold_dgq) { |
| 20751 | fusionAlg_B.Switch_by = fusionAlg_P_g.Constant7_Value_pz; |
| 20752 | } else { |
| 20753 | fusionAlg_B.Switch_by = fusionAlg_P_g.Constant8_Value_a4; |
| 20754 | } |
| 20755 | |
| 20756 | /* End of Switch: '<S96>/Switch' */ |
| 20757 | |
| 20758 | /* DataTypeConversion: '<S96>/Data Type Conversion1' */ |
| 20759 | tmp = (real32_T)floor(fusionAlg_B.Selector8_a.DynProp); |
| 20760 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20761 | tmp = 0.0F; |
| 20762 | } else { |
| 20763 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20764 | } |
| 20765 | |
| 20766 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objMotionPattern = (uint8_T) |
| 20767 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20768 | tmp); |
| 20769 | |
| 20770 | /* End of DataTypeConversion: '<S96>/Data Type Conversion1' */ |
| 20771 | |
| 20772 | /* BusCreator: '<S96>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20773 | * Constant: '<S96>/Constant' |
| 20774 | * Constant: '<S96>/Constant1' |
| 20775 | */ |
| 20776 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.reserved.reserved1 = |
| 20777 | fusionAlg_P_g.Constant_Value_ij; |
| 20778 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.reserved.reserved0 = |
| 20779 | fusionAlg_P_g.Constant1_Value_nm; |
| 20780 | |
| 20781 | /* BusCreator: '<S96>/Bus Creator1' incorporates: |
| 20782 | * Constant: '<S96>/Constant10' |
| 20783 | * Constant: '<S96>/Constant2' |
| 20784 | * Constant: '<S96>/Constant3' |
| 20785 | * Constant: '<S96>/Constant4' |
| 20786 | * Constant: '<S96>/Constant5' |
| 20787 | * Constant: '<S96>/Constant6' |
| 20788 | * Constant: '<S96>/Constant9' |
| 20789 | */ |
| 20790 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objObstacleProb = |
| 20791 | fusionAlg_B.Selector8_a.RCS; |
| 20792 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objXPos_Stdev = |
| 20793 | fusionAlg_P_g.Constant2_Value_ac; |
| 20794 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objYPos_Stdev = |
| 20795 | fusionAlg_P_g.Constant3_Value_kg; |
| 20796 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objXVelRel_Stdev = |
| 20797 | fusionAlg_P_g.Constant4_Value_f3; |
| 20798 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objXAccRel = |
| 20799 | fusionAlg_P_g.Constant5_Value_po; |
| 20800 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objExstProb = |
| 20801 | fusionAlg_P_g.Constant6_Value_hln; |
| 20802 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objYVelRel = |
| 20803 | fusionAlg_B.Selector8_a.VrelLat; |
| 20804 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objXVelRel = |
| 20805 | fusionAlg_B.Selector8_a.VrelLong; |
| 20806 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objXPos = |
| 20807 | fusionAlg_B.Selector8_a.DistLong; |
| 20808 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objYPos = |
| 20809 | fusionAlg_B.Selector8_a.DistLat; |
| 20810 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objID = |
| 20811 | fusionAlg_B.DataTypeConversion_je; |
| 20812 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objUpdateFlag = |
| 20813 | fusionAlg_B.Switch_by; |
| 20814 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objValidFlag = |
| 20815 | fusionAlg_B.Switch_by; |
| 20816 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objType = |
| 20817 | fusionAlg_P_g.Constant9_Value_pd; |
| 20818 | fusionAlg_B.BusCreator_o.radarObj.radar_09_obj.objMeasFlag = |
| 20819 | fusionAlg_P_g.Constant10_Value_pc; |
| 20820 | |
| 20821 | /* Selector: '<S55>/Selector9' incorporates: |
| 20822 | * Constant: '<S55>/Constant9' |
| 20823 | */ |
| 20824 | fusionAlg_B.Selector9_k = rtu_Radar308_Info_st-> |
| 20825 | leftRearRadar_General[fusionAlg_P_g.Constant9_Value_ki]; |
| 20826 | |
| 20827 | /* DataTypeConversion: '<S58>/Data Type Conversion' */ |
| 20828 | tmp = (real32_T)floor(fusionAlg_B.Selector9_k.ID); |
| 20829 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20830 | tmp = 0.0F; |
| 20831 | } else { |
| 20832 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20833 | } |
| 20834 | |
| 20835 | fusionAlg_B.DataTypeConversion_ou = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 20836 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20837 | |
| 20838 | /* End of DataTypeConversion: '<S58>/Data Type Conversion' */ |
| 20839 | |
| 20840 | /* Switch: '<S58>/Switch' incorporates: |
| 20841 | * Constant: '<S58>/Constant7' |
| 20842 | * Constant: '<S58>/Constant8' |
| 20843 | */ |
| 20844 | if (fusionAlg_B.DataTypeConversion_ou > fusionAlg_P_g.Switch_Threshold_e3u) { |
| 20845 | fusionAlg_B.Switch_mw3 = fusionAlg_P_g.Constant7_Value_ix; |
| 20846 | } else { |
| 20847 | fusionAlg_B.Switch_mw3 = fusionAlg_P_g.Constant8_Value_nw; |
| 20848 | } |
| 20849 | |
| 20850 | /* End of Switch: '<S58>/Switch' */ |
| 20851 | |
| 20852 | /* DataTypeConversion: '<S58>/Data Type Conversion1' */ |
| 20853 | tmp = (real32_T)floor(fusionAlg_B.Selector9_k.DynProp); |
| 20854 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20855 | tmp = 0.0F; |
| 20856 | } else { |
| 20857 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20858 | } |
| 20859 | |
| 20860 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objMotionPattern = (uint8_T) |
| 20861 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20862 | tmp); |
| 20863 | |
| 20864 | /* End of DataTypeConversion: '<S58>/Data Type Conversion1' */ |
| 20865 | |
| 20866 | /* BusCreator: '<S58>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20867 | * Constant: '<S58>/Constant' |
| 20868 | * Constant: '<S58>/Constant1' |
| 20869 | */ |
| 20870 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.reserved.reserved1 = |
| 20871 | fusionAlg_P_g.Constant_Value_b5; |
| 20872 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.reserved.reserved0 = |
| 20873 | fusionAlg_P_g.Constant1_Value_kgp; |
| 20874 | |
| 20875 | /* BusCreator: '<S58>/Bus Creator1' incorporates: |
| 20876 | * Constant: '<S58>/Constant10' |
| 20877 | * Constant: '<S58>/Constant2' |
| 20878 | * Constant: '<S58>/Constant3' |
| 20879 | * Constant: '<S58>/Constant4' |
| 20880 | * Constant: '<S58>/Constant5' |
| 20881 | * Constant: '<S58>/Constant6' |
| 20882 | * Constant: '<S58>/Constant9' |
| 20883 | */ |
| 20884 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objObstacleProb = |
| 20885 | fusionAlg_B.Selector9_k.RCS; |
| 20886 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objXPos_Stdev = |
| 20887 | fusionAlg_P_g.Constant2_Value_es; |
| 20888 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objYPos_Stdev = |
| 20889 | fusionAlg_P_g.Constant3_Value_is; |
| 20890 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objXVelRel_Stdev = |
| 20891 | fusionAlg_P_g.Constant4_Value_kvg; |
| 20892 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objXAccRel = |
| 20893 | fusionAlg_P_g.Constant5_Value_bf; |
| 20894 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objExstProb = |
| 20895 | fusionAlg_P_g.Constant6_Value_ly; |
| 20896 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objYVelRel = |
| 20897 | fusionAlg_B.Selector9_k.VrelLat; |
| 20898 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objXVelRel = |
| 20899 | fusionAlg_B.Selector9_k.VrelLong; |
| 20900 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objXPos = |
| 20901 | fusionAlg_B.Selector9_k.DistLong; |
| 20902 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objYPos = |
| 20903 | fusionAlg_B.Selector9_k.DistLat; |
| 20904 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objID = |
| 20905 | fusionAlg_B.DataTypeConversion_ou; |
| 20906 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objUpdateFlag = |
| 20907 | fusionAlg_B.Switch_mw3; |
| 20908 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objValidFlag = |
| 20909 | fusionAlg_B.Switch_mw3; |
| 20910 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objType = |
| 20911 | fusionAlg_P_g.Constant9_Value_fx; |
| 20912 | fusionAlg_B.BusCreator_o.radarObj.radar_10_obj.objMeasFlag = |
| 20913 | fusionAlg_P_g.Constant10_Value_aj; |
| 20914 | |
| 20915 | /* Selector: '<S55>/Selector10' incorporates: |
| 20916 | * Constant: '<S55>/Constant10' |
| 20917 | */ |
| 20918 | fusionAlg_B.Selector10_dq = rtu_Radar308_Info_st-> |
| 20919 | leftRearRadar_General[fusionAlg_P_g.Constant10_Value_fv]; |
| 20920 | |
| 20921 | /* DataTypeConversion: '<S59>/Data Type Conversion' */ |
| 20922 | tmp = (real32_T)floor(fusionAlg_B.Selector10_dq.ID); |
| 20923 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20924 | tmp = 0.0F; |
| 20925 | } else { |
| 20926 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 20927 | } |
| 20928 | |
| 20929 | fusionAlg_B.DataTypeConversion_c42 = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 20930 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 20931 | |
| 20932 | /* End of DataTypeConversion: '<S59>/Data Type Conversion' */ |
| 20933 | |
| 20934 | /* Switch: '<S59>/Switch' incorporates: |
| 20935 | * Constant: '<S59>/Constant7' |
| 20936 | * Constant: '<S59>/Constant8' |
| 20937 | */ |
| 20938 | if (fusionAlg_B.DataTypeConversion_c42 > fusionAlg_P_g.Switch_Threshold_fo) { |
| 20939 | fusionAlg_B.Switch_h23 = fusionAlg_P_g.Constant7_Value_c5x; |
| 20940 | } else { |
| 20941 | fusionAlg_B.Switch_h23 = fusionAlg_P_g.Constant8_Value_leu; |
| 20942 | } |
| 20943 | |
| 20944 | /* End of Switch: '<S59>/Switch' */ |
| 20945 | |
| 20946 | /* DataTypeConversion: '<S59>/Data Type Conversion1' */ |
| 20947 | tmp = (real32_T)floor(fusionAlg_B.Selector10_dq.DynProp); |
| 20948 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 20949 | tmp = 0.0F; |
| 20950 | } else { |
| 20951 | tmp = (real32_T)fmod(tmp, 256.0); |
| 20952 | } |
| 20953 | |
| 20954 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objMotionPattern = (uint8_T) |
| 20955 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 20956 | tmp); |
| 20957 | |
| 20958 | /* End of DataTypeConversion: '<S59>/Data Type Conversion1' */ |
| 20959 | |
| 20960 | /* BusCreator: '<S59>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 20961 | * Constant: '<S59>/Constant' |
| 20962 | * Constant: '<S59>/Constant1' |
| 20963 | */ |
| 20964 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.reserved.reserved1 = |
| 20965 | fusionAlg_P_g.Constant_Value_a5; |
| 20966 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.reserved.reserved0 = |
| 20967 | fusionAlg_P_g.Constant1_Value_ef; |
| 20968 | |
| 20969 | /* BusCreator: '<S59>/Bus Creator1' incorporates: |
| 20970 | * Constant: '<S59>/Constant10' |
| 20971 | * Constant: '<S59>/Constant2' |
| 20972 | * Constant: '<S59>/Constant3' |
| 20973 | * Constant: '<S59>/Constant4' |
| 20974 | * Constant: '<S59>/Constant5' |
| 20975 | * Constant: '<S59>/Constant6' |
| 20976 | * Constant: '<S59>/Constant9' |
| 20977 | */ |
| 20978 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objObstacleProb = |
| 20979 | fusionAlg_B.Selector10_dq.RCS; |
| 20980 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objXPos_Stdev = |
| 20981 | fusionAlg_P_g.Constant2_Value_h3; |
| 20982 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objYPos_Stdev = |
| 20983 | fusionAlg_P_g.Constant3_Value_hz; |
| 20984 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objXVelRel_Stdev = |
| 20985 | fusionAlg_P_g.Constant4_Value_bkm; |
| 20986 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objXAccRel = |
| 20987 | fusionAlg_P_g.Constant5_Value_fps; |
| 20988 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objExstProb = |
| 20989 | fusionAlg_P_g.Constant6_Value_oq; |
| 20990 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objYVelRel = |
| 20991 | fusionAlg_B.Selector10_dq.VrelLat; |
| 20992 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objXVelRel = |
| 20993 | fusionAlg_B.Selector10_dq.VrelLong; |
| 20994 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objXPos = |
| 20995 | fusionAlg_B.Selector10_dq.DistLong; |
| 20996 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objYPos = |
| 20997 | fusionAlg_B.Selector10_dq.DistLat; |
| 20998 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objID = |
| 20999 | fusionAlg_B.DataTypeConversion_c42; |
| 21000 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objUpdateFlag = |
| 21001 | fusionAlg_B.Switch_h23; |
| 21002 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objValidFlag = |
| 21003 | fusionAlg_B.Switch_h23; |
| 21004 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objType = |
| 21005 | fusionAlg_P_g.Constant9_Value_cig; |
| 21006 | fusionAlg_B.BusCreator_o.radarObj.radar_11_obj.objMeasFlag = |
| 21007 | fusionAlg_P_g.Constant10_Value_hoz; |
| 21008 | |
| 21009 | /* Selector: '<S55>/Selector11' incorporates: |
| 21010 | * Constant: '<S55>/Constant11' |
| 21011 | */ |
| 21012 | fusionAlg_B.Selector11_f = rtu_Radar308_Info_st-> |
| 21013 | leftRearRadar_General[fusionAlg_P_g.Constant11_Value_h]; |
| 21014 | |
| 21015 | /* DataTypeConversion: '<S60>/Data Type Conversion' */ |
| 21016 | tmp = (real32_T)floor(fusionAlg_B.Selector11_f.ID); |
| 21017 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21018 | tmp = 0.0F; |
| 21019 | } else { |
| 21020 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21021 | } |
| 21022 | |
| 21023 | fusionAlg_B.DataTypeConversion_l5 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 21024 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21025 | |
| 21026 | /* End of DataTypeConversion: '<S60>/Data Type Conversion' */ |
| 21027 | |
| 21028 | /* Switch: '<S60>/Switch' incorporates: |
| 21029 | * Constant: '<S60>/Constant7' |
| 21030 | * Constant: '<S60>/Constant8' |
| 21031 | */ |
| 21032 | if (fusionAlg_B.DataTypeConversion_l5 > fusionAlg_P_g.Switch_Threshold_n2) { |
| 21033 | fusionAlg_B.Switch_jd = fusionAlg_P_g.Constant7_Value_ka; |
| 21034 | } else { |
| 21035 | fusionAlg_B.Switch_jd = fusionAlg_P_g.Constant8_Value_gt; |
| 21036 | } |
| 21037 | |
| 21038 | /* End of Switch: '<S60>/Switch' */ |
| 21039 | |
| 21040 | /* DataTypeConversion: '<S60>/Data Type Conversion1' */ |
| 21041 | tmp = (real32_T)floor(fusionAlg_B.Selector11_f.DynProp); |
| 21042 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21043 | tmp = 0.0F; |
| 21044 | } else { |
| 21045 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21046 | } |
| 21047 | |
| 21048 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objMotionPattern = (uint8_T) |
| 21049 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21050 | tmp); |
| 21051 | |
| 21052 | /* End of DataTypeConversion: '<S60>/Data Type Conversion1' */ |
| 21053 | |
| 21054 | /* BusCreator: '<S60>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21055 | * Constant: '<S60>/Constant' |
| 21056 | * Constant: '<S60>/Constant1' |
| 21057 | */ |
| 21058 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.reserved.reserved1 = |
| 21059 | fusionAlg_P_g.Constant_Value_am4; |
| 21060 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.reserved.reserved0 = |
| 21061 | fusionAlg_P_g.Constant1_Value_hb; |
| 21062 | |
| 21063 | /* BusCreator: '<S60>/Bus Creator1' incorporates: |
| 21064 | * Constant: '<S60>/Constant10' |
| 21065 | * Constant: '<S60>/Constant2' |
| 21066 | * Constant: '<S60>/Constant3' |
| 21067 | * Constant: '<S60>/Constant4' |
| 21068 | * Constant: '<S60>/Constant5' |
| 21069 | * Constant: '<S60>/Constant6' |
| 21070 | * Constant: '<S60>/Constant9' |
| 21071 | */ |
| 21072 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objObstacleProb = |
| 21073 | fusionAlg_B.Selector11_f.RCS; |
| 21074 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objXPos_Stdev = |
| 21075 | fusionAlg_P_g.Constant2_Value_om; |
| 21076 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objYPos_Stdev = |
| 21077 | fusionAlg_P_g.Constant3_Value_g5; |
| 21078 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objXVelRel_Stdev = |
| 21079 | fusionAlg_P_g.Constant4_Value_jsk; |
| 21080 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objXAccRel = |
| 21081 | fusionAlg_P_g.Constant5_Value_ck; |
| 21082 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objExstProb = |
| 21083 | fusionAlg_P_g.Constant6_Value_ey; |
| 21084 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objYVelRel = |
| 21085 | fusionAlg_B.Selector11_f.VrelLat; |
| 21086 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objXVelRel = |
| 21087 | fusionAlg_B.Selector11_f.VrelLong; |
| 21088 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objXPos = |
| 21089 | fusionAlg_B.Selector11_f.DistLong; |
| 21090 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objYPos = |
| 21091 | fusionAlg_B.Selector11_f.DistLat; |
| 21092 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objID = |
| 21093 | fusionAlg_B.DataTypeConversion_l5; |
| 21094 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objUpdateFlag = |
| 21095 | fusionAlg_B.Switch_jd; |
| 21096 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objValidFlag = |
| 21097 | fusionAlg_B.Switch_jd; |
| 21098 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objType = |
| 21099 | fusionAlg_P_g.Constant9_Value_hd; |
| 21100 | fusionAlg_B.BusCreator_o.radarObj.radar_12_obj.objMeasFlag = |
| 21101 | fusionAlg_P_g.Constant10_Value_pa3; |
| 21102 | |
| 21103 | /* Selector: '<S55>/Selector12' incorporates: |
| 21104 | * Constant: '<S55>/Constant12' |
| 21105 | */ |
| 21106 | fusionAlg_B.Selector12_n = rtu_Radar308_Info_st-> |
| 21107 | leftRearRadar_General[fusionAlg_P_g.Constant12_Value_o]; |
| 21108 | |
| 21109 | /* DataTypeConversion: '<S61>/Data Type Conversion' */ |
| 21110 | tmp = (real32_T)floor(fusionAlg_B.Selector12_n.ID); |
| 21111 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21112 | tmp = 0.0F; |
| 21113 | } else { |
| 21114 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21115 | } |
| 21116 | |
| 21117 | fusionAlg_B.DataTypeConversion_bb = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 21118 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21119 | |
| 21120 | /* End of DataTypeConversion: '<S61>/Data Type Conversion' */ |
| 21121 | |
| 21122 | /* Switch: '<S61>/Switch' incorporates: |
| 21123 | * Constant: '<S61>/Constant7' |
| 21124 | * Constant: '<S61>/Constant8' |
| 21125 | */ |
| 21126 | if (fusionAlg_B.DataTypeConversion_bb > fusionAlg_P_g.Switch_Threshold_ga) { |
| 21127 | fusionAlg_B.Switch_al5 = fusionAlg_P_g.Constant7_Value_k0e; |
| 21128 | } else { |
| 21129 | fusionAlg_B.Switch_al5 = fusionAlg_P_g.Constant8_Value_os; |
| 21130 | } |
| 21131 | |
| 21132 | /* End of Switch: '<S61>/Switch' */ |
| 21133 | |
| 21134 | /* DataTypeConversion: '<S61>/Data Type Conversion1' */ |
| 21135 | tmp = (real32_T)floor(fusionAlg_B.Selector12_n.DynProp); |
| 21136 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21137 | tmp = 0.0F; |
| 21138 | } else { |
| 21139 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21140 | } |
| 21141 | |
| 21142 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objMotionPattern = (uint8_T) |
| 21143 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21144 | tmp); |
| 21145 | |
| 21146 | /* End of DataTypeConversion: '<S61>/Data Type Conversion1' */ |
| 21147 | |
| 21148 | /* BusCreator: '<S61>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21149 | * Constant: '<S61>/Constant' |
| 21150 | * Constant: '<S61>/Constant1' |
| 21151 | */ |
| 21152 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.reserved.reserved1 = |
| 21153 | fusionAlg_P_g.Constant_Value_hy; |
| 21154 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.reserved.reserved0 = |
| 21155 | fusionAlg_P_g.Constant1_Value_g31; |
| 21156 | |
| 21157 | /* BusCreator: '<S61>/Bus Creator1' incorporates: |
| 21158 | * Constant: '<S61>/Constant10' |
| 21159 | * Constant: '<S61>/Constant2' |
| 21160 | * Constant: '<S61>/Constant3' |
| 21161 | * Constant: '<S61>/Constant4' |
| 21162 | * Constant: '<S61>/Constant5' |
| 21163 | * Constant: '<S61>/Constant6' |
| 21164 | * Constant: '<S61>/Constant9' |
| 21165 | */ |
| 21166 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objObstacleProb = |
| 21167 | fusionAlg_B.Selector12_n.RCS; |
| 21168 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objXPos_Stdev = |
| 21169 | fusionAlg_P_g.Constant2_Value_cb; |
| 21170 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objYPos_Stdev = |
| 21171 | fusionAlg_P_g.Constant3_Value_ip; |
| 21172 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objXVelRel_Stdev = |
| 21173 | fusionAlg_P_g.Constant4_Value_ev; |
| 21174 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objXAccRel = |
| 21175 | fusionAlg_P_g.Constant5_Value_dm; |
| 21176 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objExstProb = |
| 21177 | fusionAlg_P_g.Constant6_Value_mz; |
| 21178 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objYVelRel = |
| 21179 | fusionAlg_B.Selector12_n.VrelLat; |
| 21180 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objXVelRel = |
| 21181 | fusionAlg_B.Selector12_n.VrelLong; |
| 21182 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objXPos = |
| 21183 | fusionAlg_B.Selector12_n.DistLong; |
| 21184 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objYPos = |
| 21185 | fusionAlg_B.Selector12_n.DistLat; |
| 21186 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objID = |
| 21187 | fusionAlg_B.DataTypeConversion_bb; |
| 21188 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objUpdateFlag = |
| 21189 | fusionAlg_B.Switch_al5; |
| 21190 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objValidFlag = |
| 21191 | fusionAlg_B.Switch_al5; |
| 21192 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objType = |
| 21193 | fusionAlg_P_g.Constant9_Value_i2; |
| 21194 | fusionAlg_B.BusCreator_o.radarObj.radar_13_obj.objMeasFlag = |
| 21195 | fusionAlg_P_g.Constant10_Value_ai; |
| 21196 | |
| 21197 | /* Selector: '<S55>/Selector13' incorporates: |
| 21198 | * Constant: '<S55>/Constant13' |
| 21199 | */ |
| 21200 | fusionAlg_B.Selector13_e = rtu_Radar308_Info_st-> |
| 21201 | leftRearRadar_General[fusionAlg_P_g.Constant13_Value_c]; |
| 21202 | |
| 21203 | /* DataTypeConversion: '<S62>/Data Type Conversion' */ |
| 21204 | tmp = (real32_T)floor(fusionAlg_B.Selector13_e.ID); |
| 21205 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21206 | tmp = 0.0F; |
| 21207 | } else { |
| 21208 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21209 | } |
| 21210 | |
| 21211 | fusionAlg_B.DataTypeConversion_aai = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 21212 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21213 | |
| 21214 | /* End of DataTypeConversion: '<S62>/Data Type Conversion' */ |
| 21215 | |
| 21216 | /* Switch: '<S62>/Switch' incorporates: |
| 21217 | * Constant: '<S62>/Constant7' |
| 21218 | * Constant: '<S62>/Constant8' |
| 21219 | */ |
| 21220 | if (fusionAlg_B.DataTypeConversion_aai > fusionAlg_P_g.Switch_Threshold_f5) { |
| 21221 | fusionAlg_B.Switch_gr = fusionAlg_P_g.Constant7_Value_kx; |
| 21222 | } else { |
| 21223 | fusionAlg_B.Switch_gr = fusionAlg_P_g.Constant8_Value_f2; |
| 21224 | } |
| 21225 | |
| 21226 | /* End of Switch: '<S62>/Switch' */ |
| 21227 | |
| 21228 | /* DataTypeConversion: '<S62>/Data Type Conversion1' */ |
| 21229 | tmp = (real32_T)floor(fusionAlg_B.Selector13_e.DynProp); |
| 21230 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21231 | tmp = 0.0F; |
| 21232 | } else { |
| 21233 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21234 | } |
| 21235 | |
| 21236 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objMotionPattern = (uint8_T) |
| 21237 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21238 | tmp); |
| 21239 | |
| 21240 | /* End of DataTypeConversion: '<S62>/Data Type Conversion1' */ |
| 21241 | |
| 21242 | /* BusCreator: '<S62>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21243 | * Constant: '<S62>/Constant' |
| 21244 | * Constant: '<S62>/Constant1' |
| 21245 | */ |
| 21246 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.reserved.reserved1 = |
| 21247 | fusionAlg_P_g.Constant_Value_cb; |
| 21248 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.reserved.reserved0 = |
| 21249 | fusionAlg_P_g.Constant1_Value_jdy; |
| 21250 | |
| 21251 | /* BusCreator: '<S62>/Bus Creator1' incorporates: |
| 21252 | * Constant: '<S62>/Constant10' |
| 21253 | * Constant: '<S62>/Constant2' |
| 21254 | * Constant: '<S62>/Constant3' |
| 21255 | * Constant: '<S62>/Constant4' |
| 21256 | * Constant: '<S62>/Constant5' |
| 21257 | * Constant: '<S62>/Constant6' |
| 21258 | * Constant: '<S62>/Constant9' |
| 21259 | */ |
| 21260 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objObstacleProb = |
| 21261 | fusionAlg_B.Selector13_e.RCS; |
| 21262 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objXPos_Stdev = |
| 21263 | fusionAlg_P_g.Constant2_Value_jy; |
| 21264 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objYPos_Stdev = |
| 21265 | fusionAlg_P_g.Constant3_Value_af2; |
| 21266 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objXVelRel_Stdev = |
| 21267 | fusionAlg_P_g.Constant4_Value_jq; |
| 21268 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objXAccRel = |
| 21269 | fusionAlg_P_g.Constant5_Value_lvd; |
| 21270 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objExstProb = |
| 21271 | fusionAlg_P_g.Constant6_Value_bkl; |
| 21272 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objYVelRel = |
| 21273 | fusionAlg_B.Selector13_e.VrelLat; |
| 21274 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objXVelRel = |
| 21275 | fusionAlg_B.Selector13_e.VrelLong; |
| 21276 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objXPos = |
| 21277 | fusionAlg_B.Selector13_e.DistLong; |
| 21278 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objYPos = |
| 21279 | fusionAlg_B.Selector13_e.DistLat; |
| 21280 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objID = |
| 21281 | fusionAlg_B.DataTypeConversion_aai; |
| 21282 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objUpdateFlag = |
| 21283 | fusionAlg_B.Switch_gr; |
| 21284 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objValidFlag = |
| 21285 | fusionAlg_B.Switch_gr; |
| 21286 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objType = |
| 21287 | fusionAlg_P_g.Constant9_Value_m1; |
| 21288 | fusionAlg_B.BusCreator_o.radarObj.radar_14_obj.objMeasFlag = |
| 21289 | fusionAlg_P_g.Constant10_Value_kb; |
| 21290 | |
| 21291 | /* Selector: '<S55>/Selector14' incorporates: |
| 21292 | * Constant: '<S55>/Constant14' |
| 21293 | */ |
| 21294 | fusionAlg_B.Selector14_j = rtu_Radar308_Info_st-> |
| 21295 | leftRearRadar_General[fusionAlg_P_g.Constant14_Value_o]; |
| 21296 | |
| 21297 | /* DataTypeConversion: '<S63>/Data Type Conversion' */ |
| 21298 | tmp = (real32_T)floor(fusionAlg_B.Selector14_j.ID); |
| 21299 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21300 | tmp = 0.0F; |
| 21301 | } else { |
| 21302 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21303 | } |
| 21304 | |
| 21305 | fusionAlg_B.DataTypeConversion_dm = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 21306 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21307 | |
| 21308 | /* End of DataTypeConversion: '<S63>/Data Type Conversion' */ |
| 21309 | |
| 21310 | /* Switch: '<S63>/Switch' incorporates: |
| 21311 | * Constant: '<S63>/Constant7' |
| 21312 | * Constant: '<S63>/Constant8' |
| 21313 | */ |
| 21314 | if (fusionAlg_B.DataTypeConversion_dm > fusionAlg_P_g.Switch_Threshold_cg) { |
| 21315 | fusionAlg_B.Switch_a5 = fusionAlg_P_g.Constant7_Value_dv; |
| 21316 | } else { |
| 21317 | fusionAlg_B.Switch_a5 = fusionAlg_P_g.Constant8_Value_dz; |
| 21318 | } |
| 21319 | |
| 21320 | /* End of Switch: '<S63>/Switch' */ |
| 21321 | |
| 21322 | /* DataTypeConversion: '<S63>/Data Type Conversion1' */ |
| 21323 | tmp = (real32_T)floor(fusionAlg_B.Selector14_j.DynProp); |
| 21324 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21325 | tmp = 0.0F; |
| 21326 | } else { |
| 21327 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21328 | } |
| 21329 | |
| 21330 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objMotionPattern = (uint8_T) |
| 21331 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21332 | tmp); |
| 21333 | |
| 21334 | /* End of DataTypeConversion: '<S63>/Data Type Conversion1' */ |
| 21335 | |
| 21336 | /* BusCreator: '<S63>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21337 | * Constant: '<S63>/Constant' |
| 21338 | * Constant: '<S63>/Constant1' |
| 21339 | */ |
| 21340 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.reserved.reserved1 = |
| 21341 | fusionAlg_P_g.Constant_Value_eou; |
| 21342 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.reserved.reserved0 = |
| 21343 | fusionAlg_P_g.Constant1_Value_om; |
| 21344 | |
| 21345 | /* BusCreator: '<S63>/Bus Creator1' incorporates: |
| 21346 | * Constant: '<S63>/Constant10' |
| 21347 | * Constant: '<S63>/Constant2' |
| 21348 | * Constant: '<S63>/Constant3' |
| 21349 | * Constant: '<S63>/Constant4' |
| 21350 | * Constant: '<S63>/Constant5' |
| 21351 | * Constant: '<S63>/Constant6' |
| 21352 | * Constant: '<S63>/Constant9' |
| 21353 | */ |
| 21354 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objObstacleProb = |
| 21355 | fusionAlg_B.Selector14_j.RCS; |
| 21356 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objXPos_Stdev = |
| 21357 | fusionAlg_P_g.Constant2_Value_i3i; |
| 21358 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objYPos_Stdev = |
| 21359 | fusionAlg_P_g.Constant3_Value_mz; |
| 21360 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objXVelRel_Stdev = |
| 21361 | fusionAlg_P_g.Constant4_Value_l4; |
| 21362 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objXAccRel = |
| 21363 | fusionAlg_P_g.Constant5_Value_j5w; |
| 21364 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objExstProb = |
| 21365 | fusionAlg_P_g.Constant6_Value_o1; |
| 21366 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objYVelRel = |
| 21367 | fusionAlg_B.Selector14_j.VrelLat; |
| 21368 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objXVelRel = |
| 21369 | fusionAlg_B.Selector14_j.VrelLong; |
| 21370 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objXPos = |
| 21371 | fusionAlg_B.Selector14_j.DistLong; |
| 21372 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objYPos = |
| 21373 | fusionAlg_B.Selector14_j.DistLat; |
| 21374 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objID = |
| 21375 | fusionAlg_B.DataTypeConversion_dm; |
| 21376 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objUpdateFlag = |
| 21377 | fusionAlg_B.Switch_a5; |
| 21378 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objValidFlag = |
| 21379 | fusionAlg_B.Switch_a5; |
| 21380 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objType = |
| 21381 | fusionAlg_P_g.Constant9_Value_eok; |
| 21382 | fusionAlg_B.BusCreator_o.radarObj.radar_15_obj.objMeasFlag = |
| 21383 | fusionAlg_P_g.Constant10_Value_fu; |
| 21384 | |
| 21385 | /* Selector: '<S55>/Selector15' incorporates: |
| 21386 | * Constant: '<S55>/Constant15' |
| 21387 | */ |
| 21388 | fusionAlg_B.Selector15_j = rtu_Radar308_Info_st-> |
| 21389 | leftRearRadar_General[fusionAlg_P_g.Constant15_Value_h]; |
| 21390 | |
| 21391 | /* DataTypeConversion: '<S64>/Data Type Conversion' */ |
| 21392 | tmp = (real32_T)floor(fusionAlg_B.Selector15_j.ID); |
| 21393 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21394 | tmp = 0.0F; |
| 21395 | } else { |
| 21396 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21397 | } |
| 21398 | |
| 21399 | fusionAlg_B.DataTypeConversion_gd = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 21400 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21401 | |
| 21402 | /* End of DataTypeConversion: '<S64>/Data Type Conversion' */ |
| 21403 | |
| 21404 | /* Switch: '<S64>/Switch' incorporates: |
| 21405 | * Constant: '<S64>/Constant7' |
| 21406 | * Constant: '<S64>/Constant8' |
| 21407 | */ |
| 21408 | if (fusionAlg_B.DataTypeConversion_gd > fusionAlg_P_g.Switch_Threshold_i4) { |
| 21409 | fusionAlg_B.Switch_kn = fusionAlg_P_g.Constant7_Value_kuv; |
| 21410 | } else { |
| 21411 | fusionAlg_B.Switch_kn = fusionAlg_P_g.Constant8_Value_kx; |
| 21412 | } |
| 21413 | |
| 21414 | /* End of Switch: '<S64>/Switch' */ |
| 21415 | |
| 21416 | /* DataTypeConversion: '<S64>/Data Type Conversion1' */ |
| 21417 | tmp = (real32_T)floor(fusionAlg_B.Selector15_j.DynProp); |
| 21418 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21419 | tmp = 0.0F; |
| 21420 | } else { |
| 21421 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21422 | } |
| 21423 | |
| 21424 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objMotionPattern = (uint8_T) |
| 21425 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21426 | tmp); |
| 21427 | |
| 21428 | /* End of DataTypeConversion: '<S64>/Data Type Conversion1' */ |
| 21429 | |
| 21430 | /* BusCreator: '<S64>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21431 | * Constant: '<S64>/Constant' |
| 21432 | * Constant: '<S64>/Constant1' |
| 21433 | */ |
| 21434 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.reserved.reserved1 = |
| 21435 | fusionAlg_P_g.Constant_Value_a1m; |
| 21436 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.reserved.reserved0 = |
| 21437 | fusionAlg_P_g.Constant1_Value_c4; |
| 21438 | |
| 21439 | /* BusCreator: '<S64>/Bus Creator1' incorporates: |
| 21440 | * Constant: '<S64>/Constant10' |
| 21441 | * Constant: '<S64>/Constant2' |
| 21442 | * Constant: '<S64>/Constant3' |
| 21443 | * Constant: '<S64>/Constant4' |
| 21444 | * Constant: '<S64>/Constant5' |
| 21445 | * Constant: '<S64>/Constant6' |
| 21446 | * Constant: '<S64>/Constant9' |
| 21447 | */ |
| 21448 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objObstacleProb = |
| 21449 | fusionAlg_B.Selector15_j.RCS; |
| 21450 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objXPos_Stdev = |
| 21451 | fusionAlg_P_g.Constant2_Value_gid; |
| 21452 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objYPos_Stdev = |
| 21453 | fusionAlg_P_g.Constant3_Value_g5a; |
| 21454 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objXVelRel_Stdev = |
| 21455 | fusionAlg_P_g.Constant4_Value_e2; |
| 21456 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objXAccRel = |
| 21457 | fusionAlg_P_g.Constant5_Value_gc; |
| 21458 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objExstProb = |
| 21459 | fusionAlg_P_g.Constant6_Value_evz; |
| 21460 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objYVelRel = |
| 21461 | fusionAlg_B.Selector15_j.VrelLat; |
| 21462 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objXVelRel = |
| 21463 | fusionAlg_B.Selector15_j.VrelLong; |
| 21464 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objXPos = |
| 21465 | fusionAlg_B.Selector15_j.DistLong; |
| 21466 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objYPos = |
| 21467 | fusionAlg_B.Selector15_j.DistLat; |
| 21468 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objID = |
| 21469 | fusionAlg_B.DataTypeConversion_gd; |
| 21470 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objUpdateFlag = |
| 21471 | fusionAlg_B.Switch_kn; |
| 21472 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objValidFlag = |
| 21473 | fusionAlg_B.Switch_kn; |
| 21474 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objType = |
| 21475 | fusionAlg_P_g.Constant9_Value_en; |
| 21476 | fusionAlg_B.BusCreator_o.radarObj.radar_16_obj.objMeasFlag = |
| 21477 | fusionAlg_P_g.Constant10_Value_nu; |
| 21478 | |
| 21479 | /* Selector: '<S55>/Selector16' incorporates: |
| 21480 | * Constant: '<S55>/Constant16' |
| 21481 | */ |
| 21482 | fusionAlg_B.Selector16_bu = rtu_Radar308_Info_st-> |
| 21483 | leftRearRadar_General[fusionAlg_P_g.Constant16_Value_m]; |
| 21484 | |
| 21485 | /* DataTypeConversion: '<S65>/Data Type Conversion' */ |
| 21486 | tmp = (real32_T)floor(fusionAlg_B.Selector16_bu.ID); |
| 21487 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21488 | tmp = 0.0F; |
| 21489 | } else { |
| 21490 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21491 | } |
| 21492 | |
| 21493 | fusionAlg_B.DataTypeConversion_l3 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 21494 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21495 | |
| 21496 | /* End of DataTypeConversion: '<S65>/Data Type Conversion' */ |
| 21497 | |
| 21498 | /* Switch: '<S65>/Switch' incorporates: |
| 21499 | * Constant: '<S65>/Constant7' |
| 21500 | * Constant: '<S65>/Constant8' |
| 21501 | */ |
| 21502 | if (fusionAlg_B.DataTypeConversion_l3 > fusionAlg_P_g.Switch_Threshold_ki) { |
| 21503 | fusionAlg_B.Switch_bm = fusionAlg_P_g.Constant7_Value_lil; |
| 21504 | } else { |
| 21505 | fusionAlg_B.Switch_bm = fusionAlg_P_g.Constant8_Value_a5; |
| 21506 | } |
| 21507 | |
| 21508 | /* End of Switch: '<S65>/Switch' */ |
| 21509 | |
| 21510 | /* DataTypeConversion: '<S65>/Data Type Conversion1' */ |
| 21511 | tmp = (real32_T)floor(fusionAlg_B.Selector16_bu.DynProp); |
| 21512 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21513 | tmp = 0.0F; |
| 21514 | } else { |
| 21515 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21516 | } |
| 21517 | |
| 21518 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objMotionPattern = (uint8_T) |
| 21519 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21520 | tmp); |
| 21521 | |
| 21522 | /* End of DataTypeConversion: '<S65>/Data Type Conversion1' */ |
| 21523 | |
| 21524 | /* BusCreator: '<S65>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21525 | * Constant: '<S65>/Constant' |
| 21526 | * Constant: '<S65>/Constant1' |
| 21527 | */ |
| 21528 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.reserved.reserved1 = |
| 21529 | fusionAlg_P_g.Constant_Value_e3; |
| 21530 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.reserved.reserved0 = |
| 21531 | fusionAlg_P_g.Constant1_Value_fh2; |
| 21532 | |
| 21533 | /* BusCreator: '<S65>/Bus Creator1' incorporates: |
| 21534 | * Constant: '<S65>/Constant10' |
| 21535 | * Constant: '<S65>/Constant2' |
| 21536 | * Constant: '<S65>/Constant3' |
| 21537 | * Constant: '<S65>/Constant4' |
| 21538 | * Constant: '<S65>/Constant5' |
| 21539 | * Constant: '<S65>/Constant6' |
| 21540 | * Constant: '<S65>/Constant9' |
| 21541 | */ |
| 21542 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objObstacleProb = |
| 21543 | fusionAlg_B.Selector16_bu.RCS; |
| 21544 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objXPos_Stdev = |
| 21545 | fusionAlg_P_g.Constant2_Value_mr; |
| 21546 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objYPos_Stdev = |
| 21547 | fusionAlg_P_g.Constant3_Value_bc; |
| 21548 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objXVelRel_Stdev = |
| 21549 | fusionAlg_P_g.Constant4_Value_ex; |
| 21550 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objXAccRel = |
| 21551 | fusionAlg_P_g.Constant5_Value_pv; |
| 21552 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objExstProb = |
| 21553 | fusionAlg_P_g.Constant6_Value_df; |
| 21554 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objYVelRel = |
| 21555 | fusionAlg_B.Selector16_bu.VrelLat; |
| 21556 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objXVelRel = |
| 21557 | fusionAlg_B.Selector16_bu.VrelLong; |
| 21558 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objXPos = |
| 21559 | fusionAlg_B.Selector16_bu.DistLong; |
| 21560 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objYPos = |
| 21561 | fusionAlg_B.Selector16_bu.DistLat; |
| 21562 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objID = |
| 21563 | fusionAlg_B.DataTypeConversion_l3; |
| 21564 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objUpdateFlag = |
| 21565 | fusionAlg_B.Switch_bm; |
| 21566 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objValidFlag = |
| 21567 | fusionAlg_B.Switch_bm; |
| 21568 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objType = |
| 21569 | fusionAlg_P_g.Constant9_Value_fuy; |
| 21570 | fusionAlg_B.BusCreator_o.radarObj.radar_17_obj.objMeasFlag = |
| 21571 | fusionAlg_P_g.Constant10_Value_n1; |
| 21572 | |
| 21573 | /* Selector: '<S55>/Selector24' incorporates: |
| 21574 | * Constant: '<S55>/Constant17' |
| 21575 | */ |
| 21576 | fusionAlg_B.Selector24_o = rtu_Radar308_Info_st-> |
| 21577 | leftRearRadar_General[fusionAlg_P_g.Constant17_Value_h]; |
| 21578 | |
| 21579 | /* DataTypeConversion: '<S66>/Data Type Conversion' */ |
| 21580 | tmp = (real32_T)floor(fusionAlg_B.Selector24_o.ID); |
| 21581 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21582 | tmp = 0.0F; |
| 21583 | } else { |
| 21584 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21585 | } |
| 21586 | |
| 21587 | fusionAlg_B.DataTypeConversion_nr = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 21588 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21589 | |
| 21590 | /* End of DataTypeConversion: '<S66>/Data Type Conversion' */ |
| 21591 | |
| 21592 | /* Switch: '<S66>/Switch' incorporates: |
| 21593 | * Constant: '<S66>/Constant7' |
| 21594 | * Constant: '<S66>/Constant8' |
| 21595 | */ |
| 21596 | if (fusionAlg_B.DataTypeConversion_nr > fusionAlg_P_g.Switch_Threshold_j3) { |
| 21597 | fusionAlg_B.Switch_np = fusionAlg_P_g.Constant7_Value_ix4; |
| 21598 | } else { |
| 21599 | fusionAlg_B.Switch_np = fusionAlg_P_g.Constant8_Value_hh; |
| 21600 | } |
| 21601 | |
| 21602 | /* End of Switch: '<S66>/Switch' */ |
| 21603 | |
| 21604 | /* DataTypeConversion: '<S66>/Data Type Conversion1' */ |
| 21605 | tmp = (real32_T)floor(fusionAlg_B.Selector24_o.DynProp); |
| 21606 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21607 | tmp = 0.0F; |
| 21608 | } else { |
| 21609 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21610 | } |
| 21611 | |
| 21612 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objMotionPattern = (uint8_T) |
| 21613 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21614 | tmp); |
| 21615 | |
| 21616 | /* End of DataTypeConversion: '<S66>/Data Type Conversion1' */ |
| 21617 | |
| 21618 | /* BusCreator: '<S66>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21619 | * Constant: '<S66>/Constant' |
| 21620 | * Constant: '<S66>/Constant1' |
| 21621 | */ |
| 21622 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.reserved.reserved1 = |
| 21623 | fusionAlg_P_g.Constant_Value_ms; |
| 21624 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.reserved.reserved0 = |
| 21625 | fusionAlg_P_g.Constant1_Value_hmh; |
| 21626 | |
| 21627 | /* BusCreator: '<S66>/Bus Creator1' incorporates: |
| 21628 | * Constant: '<S66>/Constant10' |
| 21629 | * Constant: '<S66>/Constant2' |
| 21630 | * Constant: '<S66>/Constant3' |
| 21631 | * Constant: '<S66>/Constant4' |
| 21632 | * Constant: '<S66>/Constant5' |
| 21633 | * Constant: '<S66>/Constant6' |
| 21634 | * Constant: '<S66>/Constant9' |
| 21635 | */ |
| 21636 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objObstacleProb = |
| 21637 | fusionAlg_B.Selector24_o.RCS; |
| 21638 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objXPos_Stdev = |
| 21639 | fusionAlg_P_g.Constant2_Value_k4; |
| 21640 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objYPos_Stdev = |
| 21641 | fusionAlg_P_g.Constant3_Value_m5; |
| 21642 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objXVelRel_Stdev = |
| 21643 | fusionAlg_P_g.Constant4_Value_jsz; |
| 21644 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objXAccRel = |
| 21645 | fusionAlg_P_g.Constant5_Value_gp; |
| 21646 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objExstProb = |
| 21647 | fusionAlg_P_g.Constant6_Value_az; |
| 21648 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objYVelRel = |
| 21649 | fusionAlg_B.Selector24_o.VrelLat; |
| 21650 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objXVelRel = |
| 21651 | fusionAlg_B.Selector24_o.VrelLong; |
| 21652 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objXPos = |
| 21653 | fusionAlg_B.Selector24_o.DistLong; |
| 21654 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objYPos = |
| 21655 | fusionAlg_B.Selector24_o.DistLat; |
| 21656 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objID = |
| 21657 | fusionAlg_B.DataTypeConversion_nr; |
| 21658 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objUpdateFlag = |
| 21659 | fusionAlg_B.Switch_np; |
| 21660 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objValidFlag = |
| 21661 | fusionAlg_B.Switch_np; |
| 21662 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objType = |
| 21663 | fusionAlg_P_g.Constant9_Value_ib; |
| 21664 | fusionAlg_B.BusCreator_o.radarObj.radar_18_obj.objMeasFlag = |
| 21665 | fusionAlg_P_g.Constant10_Value_dzc; |
| 21666 | |
| 21667 | /* Selector: '<S55>/Selector25' incorporates: |
| 21668 | * Constant: '<S55>/Constant18' |
| 21669 | */ |
| 21670 | fusionAlg_B.Selector25_c = rtu_Radar308_Info_st-> |
| 21671 | leftRearRadar_General[fusionAlg_P_g.Constant18_Value_n]; |
| 21672 | |
| 21673 | /* DataTypeConversion: '<S67>/Data Type Conversion' */ |
| 21674 | tmp = (real32_T)floor(fusionAlg_B.Selector25_c.ID); |
| 21675 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21676 | tmp = 0.0F; |
| 21677 | } else { |
| 21678 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21679 | } |
| 21680 | |
| 21681 | fusionAlg_B.DataTypeConversion_ogb = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 21682 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21683 | |
| 21684 | /* End of DataTypeConversion: '<S67>/Data Type Conversion' */ |
| 21685 | |
| 21686 | /* Switch: '<S67>/Switch' incorporates: |
| 21687 | * Constant: '<S67>/Constant7' |
| 21688 | * Constant: '<S67>/Constant8' |
| 21689 | */ |
| 21690 | if (fusionAlg_B.DataTypeConversion_ogb > fusionAlg_P_g.Switch_Threshold_e4) { |
| 21691 | fusionAlg_B.Switch_g4v = fusionAlg_P_g.Constant7_Value_ec; |
| 21692 | } else { |
| 21693 | fusionAlg_B.Switch_g4v = fusionAlg_P_g.Constant8_Value_gp; |
| 21694 | } |
| 21695 | |
| 21696 | /* End of Switch: '<S67>/Switch' */ |
| 21697 | |
| 21698 | /* DataTypeConversion: '<S67>/Data Type Conversion1' */ |
| 21699 | tmp = (real32_T)floor(fusionAlg_B.Selector25_c.DynProp); |
| 21700 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21701 | tmp = 0.0F; |
| 21702 | } else { |
| 21703 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21704 | } |
| 21705 | |
| 21706 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objMotionPattern = (uint8_T) |
| 21707 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21708 | tmp); |
| 21709 | |
| 21710 | /* End of DataTypeConversion: '<S67>/Data Type Conversion1' */ |
| 21711 | |
| 21712 | /* BusCreator: '<S67>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21713 | * Constant: '<S67>/Constant' |
| 21714 | * Constant: '<S67>/Constant1' |
| 21715 | */ |
| 21716 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.reserved.reserved1 = |
| 21717 | fusionAlg_P_g.Constant_Value_ds; |
| 21718 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.reserved.reserved0 = |
| 21719 | fusionAlg_P_g.Constant1_Value_er; |
| 21720 | |
| 21721 | /* BusCreator: '<S67>/Bus Creator1' incorporates: |
| 21722 | * Constant: '<S67>/Constant10' |
| 21723 | * Constant: '<S67>/Constant2' |
| 21724 | * Constant: '<S67>/Constant3' |
| 21725 | * Constant: '<S67>/Constant4' |
| 21726 | * Constant: '<S67>/Constant5' |
| 21727 | * Constant: '<S67>/Constant6' |
| 21728 | * Constant: '<S67>/Constant9' |
| 21729 | */ |
| 21730 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objObstacleProb = |
| 21731 | fusionAlg_B.Selector25_c.RCS; |
| 21732 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objXPos_Stdev = |
| 21733 | fusionAlg_P_g.Constant2_Value_nj; |
| 21734 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objYPos_Stdev = |
| 21735 | fusionAlg_P_g.Constant3_Value_li; |
| 21736 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objXVelRel_Stdev = |
| 21737 | fusionAlg_P_g.Constant4_Value_k3; |
| 21738 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objXAccRel = |
| 21739 | fusionAlg_P_g.Constant5_Value_daa; |
| 21740 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objExstProb = |
| 21741 | fusionAlg_P_g.Constant6_Value_kh; |
| 21742 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objYVelRel = |
| 21743 | fusionAlg_B.Selector25_c.VrelLat; |
| 21744 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objXVelRel = |
| 21745 | fusionAlg_B.Selector25_c.VrelLong; |
| 21746 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objXPos = |
| 21747 | fusionAlg_B.Selector25_c.DistLong; |
| 21748 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objYPos = |
| 21749 | fusionAlg_B.Selector25_c.DistLat; |
| 21750 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objID = |
| 21751 | fusionAlg_B.DataTypeConversion_ogb; |
| 21752 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objUpdateFlag = |
| 21753 | fusionAlg_B.Switch_g4v; |
| 21754 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objValidFlag = |
| 21755 | fusionAlg_B.Switch_g4v; |
| 21756 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objType = |
| 21757 | fusionAlg_P_g.Constant9_Value_kkt; |
| 21758 | fusionAlg_B.BusCreator_o.radarObj.radar_19_obj.objMeasFlag = |
| 21759 | fusionAlg_P_g.Constant10_Value_fk; |
| 21760 | |
| 21761 | /* Selector: '<S55>/Selector26' incorporates: |
| 21762 | * Constant: '<S55>/Constant19' |
| 21763 | */ |
| 21764 | fusionAlg_B.Selector26_am = rtu_Radar308_Info_st-> |
| 21765 | leftRearRadar_General[fusionAlg_P_g.Constant19_Value_c]; |
| 21766 | |
| 21767 | /* DataTypeConversion: '<S69>/Data Type Conversion' */ |
| 21768 | tmp = (real32_T)floor(fusionAlg_B.Selector26_am.ID); |
| 21769 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21770 | tmp = 0.0F; |
| 21771 | } else { |
| 21772 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21773 | } |
| 21774 | |
| 21775 | fusionAlg_B.DataTypeConversion_lq = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 21776 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21777 | |
| 21778 | /* End of DataTypeConversion: '<S69>/Data Type Conversion' */ |
| 21779 | |
| 21780 | /* Switch: '<S69>/Switch' incorporates: |
| 21781 | * Constant: '<S69>/Constant7' |
| 21782 | * Constant: '<S69>/Constant8' |
| 21783 | */ |
| 21784 | if (fusionAlg_B.DataTypeConversion_lq > fusionAlg_P_g.Switch_Threshold_bu) { |
| 21785 | fusionAlg_B.Switch_nv = fusionAlg_P_g.Constant7_Value_bc; |
| 21786 | } else { |
| 21787 | fusionAlg_B.Switch_nv = fusionAlg_P_g.Constant8_Value_me; |
| 21788 | } |
| 21789 | |
| 21790 | /* End of Switch: '<S69>/Switch' */ |
| 21791 | |
| 21792 | /* DataTypeConversion: '<S69>/Data Type Conversion1' */ |
| 21793 | tmp = (real32_T)floor(fusionAlg_B.Selector26_am.DynProp); |
| 21794 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21795 | tmp = 0.0F; |
| 21796 | } else { |
| 21797 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21798 | } |
| 21799 | |
| 21800 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objMotionPattern = (uint8_T) |
| 21801 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21802 | tmp); |
| 21803 | |
| 21804 | /* End of DataTypeConversion: '<S69>/Data Type Conversion1' */ |
| 21805 | |
| 21806 | /* BusCreator: '<S69>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21807 | * Constant: '<S69>/Constant' |
| 21808 | * Constant: '<S69>/Constant1' |
| 21809 | */ |
| 21810 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.reserved.reserved1 = |
| 21811 | fusionAlg_P_g.Constant_Value_mdh; |
| 21812 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.reserved.reserved0 = |
| 21813 | fusionAlg_P_g.Constant1_Value_dm; |
| 21814 | |
| 21815 | /* BusCreator: '<S69>/Bus Creator1' incorporates: |
| 21816 | * Constant: '<S69>/Constant10' |
| 21817 | * Constant: '<S69>/Constant2' |
| 21818 | * Constant: '<S69>/Constant3' |
| 21819 | * Constant: '<S69>/Constant4' |
| 21820 | * Constant: '<S69>/Constant5' |
| 21821 | * Constant: '<S69>/Constant6' |
| 21822 | * Constant: '<S69>/Constant9' |
| 21823 | */ |
| 21824 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objObstacleProb = |
| 21825 | fusionAlg_B.Selector26_am.RCS; |
| 21826 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objXPos_Stdev = |
| 21827 | fusionAlg_P_g.Constant2_Value_mw; |
| 21828 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objYPos_Stdev = |
| 21829 | fusionAlg_P_g.Constant3_Value_de4; |
| 21830 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objXVelRel_Stdev = |
| 21831 | fusionAlg_P_g.Constant4_Value_kb; |
| 21832 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objXAccRel = |
| 21833 | fusionAlg_P_g.Constant5_Value_jh; |
| 21834 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objExstProb = |
| 21835 | fusionAlg_P_g.Constant6_Value_je1; |
| 21836 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objYVelRel = |
| 21837 | fusionAlg_B.Selector26_am.VrelLat; |
| 21838 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objXVelRel = |
| 21839 | fusionAlg_B.Selector26_am.VrelLong; |
| 21840 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objXPos = |
| 21841 | fusionAlg_B.Selector26_am.DistLong; |
| 21842 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objYPos = |
| 21843 | fusionAlg_B.Selector26_am.DistLat; |
| 21844 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objID = |
| 21845 | fusionAlg_B.DataTypeConversion_lq; |
| 21846 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objUpdateFlag = |
| 21847 | fusionAlg_B.Switch_nv; |
| 21848 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objValidFlag = |
| 21849 | fusionAlg_B.Switch_nv; |
| 21850 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objType = |
| 21851 | fusionAlg_P_g.Constant9_Value_oz; |
| 21852 | fusionAlg_B.BusCreator_o.radarObj.radar_20_obj.objMeasFlag = |
| 21853 | fusionAlg_P_g.Constant10_Value_hc; |
| 21854 | |
| 21855 | /* Selector: '<S55>/Selector27' incorporates: |
| 21856 | * Constant: '<S55>/Constant20' |
| 21857 | */ |
| 21858 | fusionAlg_B.Selector27_h = rtu_Radar308_Info_st-> |
| 21859 | leftRearRadar_General[fusionAlg_P_g.Constant20_Value_k]; |
| 21860 | |
| 21861 | /* DataTypeConversion: '<S70>/Data Type Conversion' */ |
| 21862 | tmp = (real32_T)floor(fusionAlg_B.Selector27_h.ID); |
| 21863 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21864 | tmp = 0.0F; |
| 21865 | } else { |
| 21866 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21867 | } |
| 21868 | |
| 21869 | fusionAlg_B.DataTypeConversion_jn = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 21870 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21871 | |
| 21872 | /* End of DataTypeConversion: '<S70>/Data Type Conversion' */ |
| 21873 | |
| 21874 | /* Switch: '<S70>/Switch' incorporates: |
| 21875 | * Constant: '<S70>/Constant7' |
| 21876 | * Constant: '<S70>/Constant8' |
| 21877 | */ |
| 21878 | if (fusionAlg_B.DataTypeConversion_jn > fusionAlg_P_g.Switch_Threshold_e0) { |
| 21879 | fusionAlg_B.Switch_ed = fusionAlg_P_g.Constant7_Value_o0; |
| 21880 | } else { |
| 21881 | fusionAlg_B.Switch_ed = fusionAlg_P_g.Constant8_Value_fb; |
| 21882 | } |
| 21883 | |
| 21884 | /* End of Switch: '<S70>/Switch' */ |
| 21885 | |
| 21886 | /* DataTypeConversion: '<S70>/Data Type Conversion1' */ |
| 21887 | tmp = (real32_T)floor(fusionAlg_B.Selector27_h.DynProp); |
| 21888 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21889 | tmp = 0.0F; |
| 21890 | } else { |
| 21891 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21892 | } |
| 21893 | |
| 21894 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objMotionPattern = (uint8_T) |
| 21895 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21896 | tmp); |
| 21897 | |
| 21898 | /* End of DataTypeConversion: '<S70>/Data Type Conversion1' */ |
| 21899 | |
| 21900 | /* BusCreator: '<S70>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21901 | * Constant: '<S70>/Constant' |
| 21902 | * Constant: '<S70>/Constant1' |
| 21903 | */ |
| 21904 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.reserved.reserved1 = |
| 21905 | fusionAlg_P_g.Constant_Value_k0; |
| 21906 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.reserved.reserved0 = |
| 21907 | fusionAlg_P_g.Constant1_Value_fen; |
| 21908 | |
| 21909 | /* BusCreator: '<S70>/Bus Creator1' incorporates: |
| 21910 | * Constant: '<S70>/Constant10' |
| 21911 | * Constant: '<S70>/Constant2' |
| 21912 | * Constant: '<S70>/Constant3' |
| 21913 | * Constant: '<S70>/Constant4' |
| 21914 | * Constant: '<S70>/Constant5' |
| 21915 | * Constant: '<S70>/Constant6' |
| 21916 | * Constant: '<S70>/Constant9' |
| 21917 | */ |
| 21918 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objObstacleProb = |
| 21919 | fusionAlg_B.Selector27_h.RCS; |
| 21920 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objXPos_Stdev = |
| 21921 | fusionAlg_P_g.Constant2_Value_ng; |
| 21922 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objYPos_Stdev = |
| 21923 | fusionAlg_P_g.Constant3_Value_lx; |
| 21924 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objXVelRel_Stdev = |
| 21925 | fusionAlg_P_g.Constant4_Value_jt; |
| 21926 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objXAccRel = |
| 21927 | fusionAlg_P_g.Constant5_Value_lp; |
| 21928 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objExstProb = |
| 21929 | fusionAlg_P_g.Constant6_Value_d5; |
| 21930 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objYVelRel = |
| 21931 | fusionAlg_B.Selector27_h.VrelLat; |
| 21932 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objXVelRel = |
| 21933 | fusionAlg_B.Selector27_h.VrelLong; |
| 21934 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objXPos = |
| 21935 | fusionAlg_B.Selector27_h.DistLong; |
| 21936 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objYPos = |
| 21937 | fusionAlg_B.Selector27_h.DistLat; |
| 21938 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objID = |
| 21939 | fusionAlg_B.DataTypeConversion_jn; |
| 21940 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objUpdateFlag = |
| 21941 | fusionAlg_B.Switch_ed; |
| 21942 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objValidFlag = |
| 21943 | fusionAlg_B.Switch_ed; |
| 21944 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objType = |
| 21945 | fusionAlg_P_g.Constant9_Value_gi; |
| 21946 | fusionAlg_B.BusCreator_o.radarObj.radar_21_obj.objMeasFlag = |
| 21947 | fusionAlg_P_g.Constant10_Value_fz; |
| 21948 | |
| 21949 | /* Selector: '<S55>/Selector28' incorporates: |
| 21950 | * Constant: '<S55>/Constant21' |
| 21951 | */ |
| 21952 | fusionAlg_B.Selector28_b = rtu_Radar308_Info_st-> |
| 21953 | leftRearRadar_General[fusionAlg_P_g.Constant21_Value_m]; |
| 21954 | |
| 21955 | /* DataTypeConversion: '<S71>/Data Type Conversion' */ |
| 21956 | tmp = (real32_T)floor(fusionAlg_B.Selector28_b.ID); |
| 21957 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21958 | tmp = 0.0F; |
| 21959 | } else { |
| 21960 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 21961 | } |
| 21962 | |
| 21963 | fusionAlg_B.DataTypeConversion_bd = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 21964 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 21965 | |
| 21966 | /* End of DataTypeConversion: '<S71>/Data Type Conversion' */ |
| 21967 | |
| 21968 | /* Switch: '<S71>/Switch' incorporates: |
| 21969 | * Constant: '<S71>/Constant7' |
| 21970 | * Constant: '<S71>/Constant8' |
| 21971 | */ |
| 21972 | if (fusionAlg_B.DataTypeConversion_bd > fusionAlg_P_g.Switch_Threshold_cc2) { |
| 21973 | fusionAlg_B.Switch_fp = fusionAlg_P_g.Constant7_Value_bdb; |
| 21974 | } else { |
| 21975 | fusionAlg_B.Switch_fp = fusionAlg_P_g.Constant8_Value_i0w; |
| 21976 | } |
| 21977 | |
| 21978 | /* End of Switch: '<S71>/Switch' */ |
| 21979 | |
| 21980 | /* DataTypeConversion: '<S71>/Data Type Conversion1' */ |
| 21981 | tmp = (real32_T)floor(fusionAlg_B.Selector28_b.DynProp); |
| 21982 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 21983 | tmp = 0.0F; |
| 21984 | } else { |
| 21985 | tmp = (real32_T)fmod(tmp, 256.0); |
| 21986 | } |
| 21987 | |
| 21988 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objMotionPattern = (uint8_T) |
| 21989 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 21990 | tmp); |
| 21991 | |
| 21992 | /* End of DataTypeConversion: '<S71>/Data Type Conversion1' */ |
| 21993 | |
| 21994 | /* BusCreator: '<S71>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 21995 | * Constant: '<S71>/Constant' |
| 21996 | * Constant: '<S71>/Constant1' |
| 21997 | */ |
| 21998 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.reserved.reserved1 = |
| 21999 | fusionAlg_P_g.Constant_Value_nrx; |
| 22000 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.reserved.reserved0 = |
| 22001 | fusionAlg_P_g.Constant1_Value_dp; |
| 22002 | |
| 22003 | /* BusCreator: '<S71>/Bus Creator1' incorporates: |
| 22004 | * Constant: '<S71>/Constant10' |
| 22005 | * Constant: '<S71>/Constant2' |
| 22006 | * Constant: '<S71>/Constant3' |
| 22007 | * Constant: '<S71>/Constant4' |
| 22008 | * Constant: '<S71>/Constant5' |
| 22009 | * Constant: '<S71>/Constant6' |
| 22010 | * Constant: '<S71>/Constant9' |
| 22011 | */ |
| 22012 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objObstacleProb = |
| 22013 | fusionAlg_B.Selector28_b.RCS; |
| 22014 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objXPos_Stdev = |
| 22015 | fusionAlg_P_g.Constant2_Value_cm; |
| 22016 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objYPos_Stdev = |
| 22017 | fusionAlg_P_g.Constant3_Value_oj; |
| 22018 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objXVelRel_Stdev = |
| 22019 | fusionAlg_P_g.Constant4_Value_jw; |
| 22020 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objXAccRel = |
| 22021 | fusionAlg_P_g.Constant5_Value_cs; |
| 22022 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objExstProb = |
| 22023 | fusionAlg_P_g.Constant6_Value_fh; |
| 22024 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objYVelRel = |
| 22025 | fusionAlg_B.Selector28_b.VrelLat; |
| 22026 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objXVelRel = |
| 22027 | fusionAlg_B.Selector28_b.VrelLong; |
| 22028 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objXPos = |
| 22029 | fusionAlg_B.Selector28_b.DistLong; |
| 22030 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objYPos = |
| 22031 | fusionAlg_B.Selector28_b.DistLat; |
| 22032 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objID = |
| 22033 | fusionAlg_B.DataTypeConversion_bd; |
| 22034 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objUpdateFlag = |
| 22035 | fusionAlg_B.Switch_fp; |
| 22036 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objValidFlag = |
| 22037 | fusionAlg_B.Switch_fp; |
| 22038 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objType = |
| 22039 | fusionAlg_P_g.Constant9_Value_dh; |
| 22040 | fusionAlg_B.BusCreator_o.radarObj.radar_22_obj.objMeasFlag = |
| 22041 | fusionAlg_P_g.Constant10_Value_om; |
| 22042 | |
| 22043 | /* Selector: '<S55>/Selector29' incorporates: |
| 22044 | * Constant: '<S55>/Constant22' |
| 22045 | */ |
| 22046 | fusionAlg_B.Selector29_c = rtu_Radar308_Info_st-> |
| 22047 | leftRearRadar_General[fusionAlg_P_g.Constant22_Value_n]; |
| 22048 | |
| 22049 | /* DataTypeConversion: '<S72>/Data Type Conversion' */ |
| 22050 | tmp = (real32_T)floor(fusionAlg_B.Selector29_c.ID); |
| 22051 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22052 | tmp = 0.0F; |
| 22053 | } else { |
| 22054 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22055 | } |
| 22056 | |
| 22057 | fusionAlg_B.DataTypeConversion_bf = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 22058 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22059 | |
| 22060 | /* End of DataTypeConversion: '<S72>/Data Type Conversion' */ |
| 22061 | |
| 22062 | /* Switch: '<S72>/Switch' incorporates: |
| 22063 | * Constant: '<S72>/Constant7' |
| 22064 | * Constant: '<S72>/Constant8' |
| 22065 | */ |
| 22066 | if (fusionAlg_B.DataTypeConversion_bf > fusionAlg_P_g.Switch_Threshold_fs) { |
| 22067 | fusionAlg_B.Switch_br = fusionAlg_P_g.Constant7_Value_hxj; |
| 22068 | } else { |
| 22069 | fusionAlg_B.Switch_br = fusionAlg_P_g.Constant8_Value_fj; |
| 22070 | } |
| 22071 | |
| 22072 | /* End of Switch: '<S72>/Switch' */ |
| 22073 | |
| 22074 | /* DataTypeConversion: '<S72>/Data Type Conversion1' */ |
| 22075 | tmp = (real32_T)floor(fusionAlg_B.Selector29_c.DynProp); |
| 22076 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22077 | tmp = 0.0F; |
| 22078 | } else { |
| 22079 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22080 | } |
| 22081 | |
| 22082 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objMotionPattern = (uint8_T) |
| 22083 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22084 | tmp); |
| 22085 | |
| 22086 | /* End of DataTypeConversion: '<S72>/Data Type Conversion1' */ |
| 22087 | |
| 22088 | /* BusCreator: '<S72>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22089 | * Constant: '<S72>/Constant' |
| 22090 | * Constant: '<S72>/Constant1' |
| 22091 | */ |
| 22092 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.reserved.reserved1 = |
| 22093 | fusionAlg_P_g.Constant_Value_mw; |
| 22094 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.reserved.reserved0 = |
| 22095 | fusionAlg_P_g.Constant1_Value_il; |
| 22096 | |
| 22097 | /* BusCreator: '<S72>/Bus Creator1' incorporates: |
| 22098 | * Constant: '<S72>/Constant10' |
| 22099 | * Constant: '<S72>/Constant2' |
| 22100 | * Constant: '<S72>/Constant3' |
| 22101 | * Constant: '<S72>/Constant4' |
| 22102 | * Constant: '<S72>/Constant5' |
| 22103 | * Constant: '<S72>/Constant6' |
| 22104 | * Constant: '<S72>/Constant9' |
| 22105 | */ |
| 22106 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objObstacleProb = |
| 22107 | fusionAlg_B.Selector29_c.RCS; |
| 22108 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objXPos_Stdev = |
| 22109 | fusionAlg_P_g.Constant2_Value_ge; |
| 22110 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objYPos_Stdev = |
| 22111 | fusionAlg_P_g.Constant3_Value_fwn; |
| 22112 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objXVelRel_Stdev = |
| 22113 | fusionAlg_P_g.Constant4_Value_l2; |
| 22114 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objXAccRel = |
| 22115 | fusionAlg_P_g.Constant5_Value_ic; |
| 22116 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objExstProb = |
| 22117 | fusionAlg_P_g.Constant6_Value_my; |
| 22118 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objYVelRel = |
| 22119 | fusionAlg_B.Selector29_c.VrelLat; |
| 22120 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objXVelRel = |
| 22121 | fusionAlg_B.Selector29_c.VrelLong; |
| 22122 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objXPos = |
| 22123 | fusionAlg_B.Selector29_c.DistLong; |
| 22124 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objYPos = |
| 22125 | fusionAlg_B.Selector29_c.DistLat; |
| 22126 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objID = |
| 22127 | fusionAlg_B.DataTypeConversion_bf; |
| 22128 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objUpdateFlag = |
| 22129 | fusionAlg_B.Switch_br; |
| 22130 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objValidFlag = |
| 22131 | fusionAlg_B.Switch_br; |
| 22132 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objType = |
| 22133 | fusionAlg_P_g.Constant9_Value_c1; |
| 22134 | fusionAlg_B.BusCreator_o.radarObj.radar_23_obj.objMeasFlag = |
| 22135 | fusionAlg_P_g.Constant10_Value_cg; |
| 22136 | |
| 22137 | /* Selector: '<S55>/Selector30' incorporates: |
| 22138 | * Constant: '<S55>/Constant23' |
| 22139 | */ |
| 22140 | fusionAlg_B.Selector30_d = rtu_Radar308_Info_st-> |
| 22141 | leftRearRadar_General[fusionAlg_P_g.Constant23_Value_p]; |
| 22142 | |
| 22143 | /* DataTypeConversion: '<S73>/Data Type Conversion' */ |
| 22144 | tmp = (real32_T)floor(fusionAlg_B.Selector30_d.ID); |
| 22145 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22146 | tmp = 0.0F; |
| 22147 | } else { |
| 22148 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22149 | } |
| 22150 | |
| 22151 | fusionAlg_B.DataTypeConversion_gds = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 22152 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22153 | |
| 22154 | /* End of DataTypeConversion: '<S73>/Data Type Conversion' */ |
| 22155 | |
| 22156 | /* Switch: '<S73>/Switch' incorporates: |
| 22157 | * Constant: '<S73>/Constant7' |
| 22158 | * Constant: '<S73>/Constant8' |
| 22159 | */ |
| 22160 | if (fusionAlg_B.DataTypeConversion_gds > fusionAlg_P_g.Switch_Threshold_jo) { |
| 22161 | fusionAlg_B.Switch_bdf = fusionAlg_P_g.Constant7_Value_ci; |
| 22162 | } else { |
| 22163 | fusionAlg_B.Switch_bdf = fusionAlg_P_g.Constant8_Value_h0; |
| 22164 | } |
| 22165 | |
| 22166 | /* End of Switch: '<S73>/Switch' */ |
| 22167 | |
| 22168 | /* DataTypeConversion: '<S73>/Data Type Conversion1' */ |
| 22169 | tmp = (real32_T)floor(fusionAlg_B.Selector30_d.DynProp); |
| 22170 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22171 | tmp = 0.0F; |
| 22172 | } else { |
| 22173 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22174 | } |
| 22175 | |
| 22176 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objMotionPattern = (uint8_T) |
| 22177 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22178 | tmp); |
| 22179 | |
| 22180 | /* End of DataTypeConversion: '<S73>/Data Type Conversion1' */ |
| 22181 | |
| 22182 | /* BusCreator: '<S73>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22183 | * Constant: '<S73>/Constant' |
| 22184 | * Constant: '<S73>/Constant1' |
| 22185 | */ |
| 22186 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.reserved.reserved1 = |
| 22187 | fusionAlg_P_g.Constant_Value_fnq; |
| 22188 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.reserved.reserved0 = |
| 22189 | fusionAlg_P_g.Constant1_Value_gp; |
| 22190 | |
| 22191 | /* BusCreator: '<S73>/Bus Creator1' incorporates: |
| 22192 | * Constant: '<S73>/Constant10' |
| 22193 | * Constant: '<S73>/Constant2' |
| 22194 | * Constant: '<S73>/Constant3' |
| 22195 | * Constant: '<S73>/Constant4' |
| 22196 | * Constant: '<S73>/Constant5' |
| 22197 | * Constant: '<S73>/Constant6' |
| 22198 | * Constant: '<S73>/Constant9' |
| 22199 | */ |
| 22200 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objObstacleProb = |
| 22201 | fusionAlg_B.Selector30_d.RCS; |
| 22202 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objXPos_Stdev = |
| 22203 | fusionAlg_P_g.Constant2_Value_ht; |
| 22204 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objYPos_Stdev = |
| 22205 | fusionAlg_P_g.Constant3_Value_ee; |
| 22206 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objXVelRel_Stdev = |
| 22207 | fusionAlg_P_g.Constant4_Value_kw; |
| 22208 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objXAccRel = |
| 22209 | fusionAlg_P_g.Constant5_Value_fr; |
| 22210 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objExstProb = |
| 22211 | fusionAlg_P_g.Constant6_Value_pn; |
| 22212 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objYVelRel = |
| 22213 | fusionAlg_B.Selector30_d.VrelLat; |
| 22214 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objXVelRel = |
| 22215 | fusionAlg_B.Selector30_d.VrelLong; |
| 22216 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objXPos = |
| 22217 | fusionAlg_B.Selector30_d.DistLong; |
| 22218 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objYPos = |
| 22219 | fusionAlg_B.Selector30_d.DistLat; |
| 22220 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objID = |
| 22221 | fusionAlg_B.DataTypeConversion_gds; |
| 22222 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objUpdateFlag = |
| 22223 | fusionAlg_B.Switch_bdf; |
| 22224 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objValidFlag = |
| 22225 | fusionAlg_B.Switch_bdf; |
| 22226 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objType = |
| 22227 | fusionAlg_P_g.Constant9_Value_h0; |
| 22228 | fusionAlg_B.BusCreator_o.radarObj.radar_24_obj.objMeasFlag = |
| 22229 | fusionAlg_P_g.Constant10_Value_ot; |
| 22230 | |
| 22231 | /* Selector: '<S55>/Selector17' incorporates: |
| 22232 | * Constant: '<S55>/Constant24' |
| 22233 | */ |
| 22234 | fusionAlg_B.Selector17_a = rtu_Radar308_Info_st-> |
| 22235 | leftRearRadar_General[fusionAlg_P_g.Constant24_Value_m]; |
| 22236 | |
| 22237 | /* DataTypeConversion: '<S74>/Data Type Conversion' */ |
| 22238 | tmp = (real32_T)floor(fusionAlg_B.Selector17_a.ID); |
| 22239 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22240 | tmp = 0.0F; |
| 22241 | } else { |
| 22242 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22243 | } |
| 22244 | |
| 22245 | fusionAlg_B.DataTypeConversion_piy = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 22246 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22247 | |
| 22248 | /* End of DataTypeConversion: '<S74>/Data Type Conversion' */ |
| 22249 | |
| 22250 | /* Switch: '<S74>/Switch' incorporates: |
| 22251 | * Constant: '<S74>/Constant7' |
| 22252 | * Constant: '<S74>/Constant8' |
| 22253 | */ |
| 22254 | if (fusionAlg_B.DataTypeConversion_piy > fusionAlg_P_g.Switch_Threshold_li) { |
| 22255 | fusionAlg_B.Switch_b3 = fusionAlg_P_g.Constant7_Value_co; |
| 22256 | } else { |
| 22257 | fusionAlg_B.Switch_b3 = fusionAlg_P_g.Constant8_Value_fwu; |
| 22258 | } |
| 22259 | |
| 22260 | /* End of Switch: '<S74>/Switch' */ |
| 22261 | |
| 22262 | /* DataTypeConversion: '<S74>/Data Type Conversion1' */ |
| 22263 | tmp = (real32_T)floor(fusionAlg_B.Selector17_a.DynProp); |
| 22264 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22265 | tmp = 0.0F; |
| 22266 | } else { |
| 22267 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22268 | } |
| 22269 | |
| 22270 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objMotionPattern = (uint8_T) |
| 22271 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22272 | tmp); |
| 22273 | |
| 22274 | /* End of DataTypeConversion: '<S74>/Data Type Conversion1' */ |
| 22275 | |
| 22276 | /* BusCreator: '<S74>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22277 | * Constant: '<S74>/Constant' |
| 22278 | * Constant: '<S74>/Constant1' |
| 22279 | */ |
| 22280 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.reserved.reserved1 = |
| 22281 | fusionAlg_P_g.Constant_Value_g3; |
| 22282 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.reserved.reserved0 = |
| 22283 | fusionAlg_P_g.Constant1_Value_c5; |
| 22284 | |
| 22285 | /* BusCreator: '<S74>/Bus Creator1' incorporates: |
| 22286 | * Constant: '<S74>/Constant10' |
| 22287 | * Constant: '<S74>/Constant2' |
| 22288 | * Constant: '<S74>/Constant3' |
| 22289 | * Constant: '<S74>/Constant4' |
| 22290 | * Constant: '<S74>/Constant5' |
| 22291 | * Constant: '<S74>/Constant6' |
| 22292 | * Constant: '<S74>/Constant9' |
| 22293 | */ |
| 22294 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objObstacleProb = |
| 22295 | fusionAlg_B.Selector17_a.RCS; |
| 22296 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objXPos_Stdev = |
| 22297 | fusionAlg_P_g.Constant2_Value_n4w; |
| 22298 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objYPos_Stdev = |
| 22299 | fusionAlg_P_g.Constant3_Value_k3; |
| 22300 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objXVelRel_Stdev = |
| 22301 | fusionAlg_P_g.Constant4_Value_ks; |
| 22302 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objXAccRel = |
| 22303 | fusionAlg_P_g.Constant5_Value_fw; |
| 22304 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objExstProb = |
| 22305 | fusionAlg_P_g.Constant6_Value_iy; |
| 22306 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objYVelRel = |
| 22307 | fusionAlg_B.Selector17_a.VrelLat; |
| 22308 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objXVelRel = |
| 22309 | fusionAlg_B.Selector17_a.VrelLong; |
| 22310 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objXPos = |
| 22311 | fusionAlg_B.Selector17_a.DistLong; |
| 22312 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objYPos = |
| 22313 | fusionAlg_B.Selector17_a.DistLat; |
| 22314 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objID = |
| 22315 | fusionAlg_B.DataTypeConversion_piy; |
| 22316 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objUpdateFlag = |
| 22317 | fusionAlg_B.Switch_b3; |
| 22318 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objValidFlag = |
| 22319 | fusionAlg_B.Switch_b3; |
| 22320 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objType = |
| 22321 | fusionAlg_P_g.Constant9_Value_ft; |
| 22322 | fusionAlg_B.BusCreator_o.radarObj.radar_25_obj.objMeasFlag = |
| 22323 | fusionAlg_P_g.Constant10_Value_bb; |
| 22324 | |
| 22325 | /* Selector: '<S55>/Selector18' incorporates: |
| 22326 | * Constant: '<S55>/Constant25' |
| 22327 | */ |
| 22328 | fusionAlg_B.Selector18_m = rtu_Radar308_Info_st-> |
| 22329 | leftRearRadar_General[fusionAlg_P_g.Constant25_Value_k]; |
| 22330 | |
| 22331 | /* DataTypeConversion: '<S75>/Data Type Conversion' */ |
| 22332 | tmp = (real32_T)floor(fusionAlg_B.Selector18_m.ID); |
| 22333 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22334 | tmp = 0.0F; |
| 22335 | } else { |
| 22336 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22337 | } |
| 22338 | |
| 22339 | fusionAlg_B.DataTypeConversion_jnk = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 22340 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22341 | |
| 22342 | /* End of DataTypeConversion: '<S75>/Data Type Conversion' */ |
| 22343 | |
| 22344 | /* Switch: '<S75>/Switch' incorporates: |
| 22345 | * Constant: '<S75>/Constant7' |
| 22346 | * Constant: '<S75>/Constant8' |
| 22347 | */ |
| 22348 | if (fusionAlg_B.DataTypeConversion_jnk > fusionAlg_P_g.Switch_Threshold_kr) { |
| 22349 | fusionAlg_B.Switch_gs = fusionAlg_P_g.Constant7_Value_jc; |
| 22350 | } else { |
| 22351 | fusionAlg_B.Switch_gs = fusionAlg_P_g.Constant8_Value_ly; |
| 22352 | } |
| 22353 | |
| 22354 | /* End of Switch: '<S75>/Switch' */ |
| 22355 | |
| 22356 | /* DataTypeConversion: '<S75>/Data Type Conversion1' */ |
| 22357 | tmp = (real32_T)floor(fusionAlg_B.Selector18_m.DynProp); |
| 22358 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22359 | tmp = 0.0F; |
| 22360 | } else { |
| 22361 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22362 | } |
| 22363 | |
| 22364 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objMotionPattern = (uint8_T) |
| 22365 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22366 | tmp); |
| 22367 | |
| 22368 | /* End of DataTypeConversion: '<S75>/Data Type Conversion1' */ |
| 22369 | |
| 22370 | /* BusCreator: '<S75>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22371 | * Constant: '<S75>/Constant' |
| 22372 | * Constant: '<S75>/Constant1' |
| 22373 | */ |
| 22374 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.reserved.reserved1 = |
| 22375 | fusionAlg_P_g.Constant_Value_d24; |
| 22376 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.reserved.reserved0 = |
| 22377 | fusionAlg_P_g.Constant1_Value_ef2; |
| 22378 | |
| 22379 | /* BusCreator: '<S75>/Bus Creator1' incorporates: |
| 22380 | * Constant: '<S75>/Constant10' |
| 22381 | * Constant: '<S75>/Constant2' |
| 22382 | * Constant: '<S75>/Constant3' |
| 22383 | * Constant: '<S75>/Constant4' |
| 22384 | * Constant: '<S75>/Constant5' |
| 22385 | * Constant: '<S75>/Constant6' |
| 22386 | * Constant: '<S75>/Constant9' |
| 22387 | */ |
| 22388 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objObstacleProb = |
| 22389 | fusionAlg_B.Selector18_m.RCS; |
| 22390 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objXPos_Stdev = |
| 22391 | fusionAlg_P_g.Constant2_Value_k5; |
| 22392 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objYPos_Stdev = |
| 22393 | fusionAlg_P_g.Constant3_Value_bb; |
| 22394 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objXVelRel_Stdev = |
| 22395 | fusionAlg_P_g.Constant4_Value_i2; |
| 22396 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objXAccRel = |
| 22397 | fusionAlg_P_g.Constant5_Value_lt; |
| 22398 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objExstProb = |
| 22399 | fusionAlg_P_g.Constant6_Value_nn; |
| 22400 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objYVelRel = |
| 22401 | fusionAlg_B.Selector18_m.VrelLat; |
| 22402 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objXVelRel = |
| 22403 | fusionAlg_B.Selector18_m.VrelLong; |
| 22404 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objXPos = |
| 22405 | fusionAlg_B.Selector18_m.DistLong; |
| 22406 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objYPos = |
| 22407 | fusionAlg_B.Selector18_m.DistLat; |
| 22408 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objID = |
| 22409 | fusionAlg_B.DataTypeConversion_jnk; |
| 22410 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objUpdateFlag = |
| 22411 | fusionAlg_B.Switch_gs; |
| 22412 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objValidFlag = |
| 22413 | fusionAlg_B.Switch_gs; |
| 22414 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objType = |
| 22415 | fusionAlg_P_g.Constant9_Value_hk; |
| 22416 | fusionAlg_B.BusCreator_o.radarObj.radar_26_obj.objMeasFlag = |
| 22417 | fusionAlg_P_g.Constant10_Value_gef; |
| 22418 | |
| 22419 | /* Selector: '<S55>/Selector19' incorporates: |
| 22420 | * Constant: '<S55>/Constant26' |
| 22421 | */ |
| 22422 | fusionAlg_B.Selector19_p = rtu_Radar308_Info_st-> |
| 22423 | leftRearRadar_General[fusionAlg_P_g.Constant26_Value_i]; |
| 22424 | |
| 22425 | /* DataTypeConversion: '<S76>/Data Type Conversion' */ |
| 22426 | tmp = (real32_T)floor(fusionAlg_B.Selector19_p.ID); |
| 22427 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22428 | tmp = 0.0F; |
| 22429 | } else { |
| 22430 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22431 | } |
| 22432 | |
| 22433 | fusionAlg_B.DataTypeConversion_h3 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 22434 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22435 | |
| 22436 | /* End of DataTypeConversion: '<S76>/Data Type Conversion' */ |
| 22437 | |
| 22438 | /* Switch: '<S76>/Switch' incorporates: |
| 22439 | * Constant: '<S76>/Constant7' |
| 22440 | * Constant: '<S76>/Constant8' |
| 22441 | */ |
| 22442 | if (fusionAlg_B.DataTypeConversion_h3 > fusionAlg_P_g.Switch_Threshold_hi) { |
| 22443 | fusionAlg_B.Switch_lb = fusionAlg_P_g.Constant7_Value_mf; |
| 22444 | } else { |
| 22445 | fusionAlg_B.Switch_lb = fusionAlg_P_g.Constant8_Value_ft; |
| 22446 | } |
| 22447 | |
| 22448 | /* End of Switch: '<S76>/Switch' */ |
| 22449 | |
| 22450 | /* DataTypeConversion: '<S76>/Data Type Conversion1' */ |
| 22451 | tmp = (real32_T)floor(fusionAlg_B.Selector19_p.DynProp); |
| 22452 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22453 | tmp = 0.0F; |
| 22454 | } else { |
| 22455 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22456 | } |
| 22457 | |
| 22458 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objMotionPattern = (uint8_T) |
| 22459 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22460 | tmp); |
| 22461 | |
| 22462 | /* End of DataTypeConversion: '<S76>/Data Type Conversion1' */ |
| 22463 | |
| 22464 | /* BusCreator: '<S76>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22465 | * Constant: '<S76>/Constant' |
| 22466 | * Constant: '<S76>/Constant1' |
| 22467 | */ |
| 22468 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.reserved.reserved1 = |
| 22469 | fusionAlg_P_g.Constant_Value_p1; |
| 22470 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.reserved.reserved0 = |
| 22471 | fusionAlg_P_g.Constant1_Value_ibg; |
| 22472 | |
| 22473 | /* BusCreator: '<S76>/Bus Creator1' incorporates: |
| 22474 | * Constant: '<S76>/Constant10' |
| 22475 | * Constant: '<S76>/Constant2' |
| 22476 | * Constant: '<S76>/Constant3' |
| 22477 | * Constant: '<S76>/Constant4' |
| 22478 | * Constant: '<S76>/Constant5' |
| 22479 | * Constant: '<S76>/Constant6' |
| 22480 | * Constant: '<S76>/Constant9' |
| 22481 | */ |
| 22482 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objObstacleProb = |
| 22483 | fusionAlg_B.Selector19_p.RCS; |
| 22484 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objXPos_Stdev = |
| 22485 | fusionAlg_P_g.Constant2_Value_oy; |
| 22486 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objYPos_Stdev = |
| 22487 | fusionAlg_P_g.Constant3_Value_msw; |
| 22488 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objXVelRel_Stdev = |
| 22489 | fusionAlg_P_g.Constant4_Value_go; |
| 22490 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objXAccRel = |
| 22491 | fusionAlg_P_g.Constant5_Value_ms; |
| 22492 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objExstProb = |
| 22493 | fusionAlg_P_g.Constant6_Value_lw; |
| 22494 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objYVelRel = |
| 22495 | fusionAlg_B.Selector19_p.VrelLat; |
| 22496 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objXVelRel = |
| 22497 | fusionAlg_B.Selector19_p.VrelLong; |
| 22498 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objXPos = |
| 22499 | fusionAlg_B.Selector19_p.DistLong; |
| 22500 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objYPos = |
| 22501 | fusionAlg_B.Selector19_p.DistLat; |
| 22502 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objID = |
| 22503 | fusionAlg_B.DataTypeConversion_h3; |
| 22504 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objUpdateFlag = |
| 22505 | fusionAlg_B.Switch_lb; |
| 22506 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objValidFlag = |
| 22507 | fusionAlg_B.Switch_lb; |
| 22508 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objType = |
| 22509 | fusionAlg_P_g.Constant9_Value_oc; |
| 22510 | fusionAlg_B.BusCreator_o.radarObj.radar_27_obj.objMeasFlag = |
| 22511 | fusionAlg_P_g.Constant10_Value_ff; |
| 22512 | |
| 22513 | /* Selector: '<S55>/Selector20' incorporates: |
| 22514 | * Constant: '<S55>/Constant27' |
| 22515 | */ |
| 22516 | fusionAlg_B.Selector20_d = rtu_Radar308_Info_st-> |
| 22517 | leftRearRadar_General[fusionAlg_P_g.Constant27_Value_h]; |
| 22518 | |
| 22519 | /* DataTypeConversion: '<S77>/Data Type Conversion' */ |
| 22520 | tmp = (real32_T)floor(fusionAlg_B.Selector20_d.ID); |
| 22521 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22522 | tmp = 0.0F; |
| 22523 | } else { |
| 22524 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22525 | } |
| 22526 | |
| 22527 | fusionAlg_B.DataTypeConversion_c4t = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 22528 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22529 | |
| 22530 | /* End of DataTypeConversion: '<S77>/Data Type Conversion' */ |
| 22531 | |
| 22532 | /* Switch: '<S77>/Switch' incorporates: |
| 22533 | * Constant: '<S77>/Constant7' |
| 22534 | * Constant: '<S77>/Constant8' |
| 22535 | */ |
| 22536 | if (fusionAlg_B.DataTypeConversion_c4t > fusionAlg_P_g.Switch_Threshold_mz) { |
| 22537 | fusionAlg_B.Switch_kgw = fusionAlg_P_g.Constant7_Value_er; |
| 22538 | } else { |
| 22539 | fusionAlg_B.Switch_kgw = fusionAlg_P_g.Constant8_Value_ma; |
| 22540 | } |
| 22541 | |
| 22542 | /* End of Switch: '<S77>/Switch' */ |
| 22543 | |
| 22544 | /* DataTypeConversion: '<S77>/Data Type Conversion1' */ |
| 22545 | tmp = (real32_T)floor(fusionAlg_B.Selector20_d.DynProp); |
| 22546 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22547 | tmp = 0.0F; |
| 22548 | } else { |
| 22549 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22550 | } |
| 22551 | |
| 22552 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objMotionPattern = (uint8_T) |
| 22553 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22554 | tmp); |
| 22555 | |
| 22556 | /* End of DataTypeConversion: '<S77>/Data Type Conversion1' */ |
| 22557 | |
| 22558 | /* BusCreator: '<S77>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22559 | * Constant: '<S77>/Constant' |
| 22560 | * Constant: '<S77>/Constant1' |
| 22561 | */ |
| 22562 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.reserved.reserved1 = |
| 22563 | fusionAlg_P_g.Constant_Value_ot; |
| 22564 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.reserved.reserved0 = |
| 22565 | fusionAlg_P_g.Constant1_Value_k5y; |
| 22566 | |
| 22567 | /* BusCreator: '<S77>/Bus Creator1' incorporates: |
| 22568 | * Constant: '<S77>/Constant10' |
| 22569 | * Constant: '<S77>/Constant2' |
| 22570 | * Constant: '<S77>/Constant3' |
| 22571 | * Constant: '<S77>/Constant4' |
| 22572 | * Constant: '<S77>/Constant5' |
| 22573 | * Constant: '<S77>/Constant6' |
| 22574 | * Constant: '<S77>/Constant9' |
| 22575 | */ |
| 22576 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objObstacleProb = |
| 22577 | fusionAlg_B.Selector20_d.RCS; |
| 22578 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objXPos_Stdev = |
| 22579 | fusionAlg_P_g.Constant2_Value_j2; |
| 22580 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objYPos_Stdev = |
| 22581 | fusionAlg_P_g.Constant3_Value_ew; |
| 22582 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objXVelRel_Stdev = |
| 22583 | fusionAlg_P_g.Constant4_Value_b4; |
| 22584 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objXAccRel = |
| 22585 | fusionAlg_P_g.Constant5_Value_kk; |
| 22586 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objExstProb = |
| 22587 | fusionAlg_P_g.Constant6_Value_m4; |
| 22588 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objYVelRel = |
| 22589 | fusionAlg_B.Selector20_d.VrelLat; |
| 22590 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objXVelRel = |
| 22591 | fusionAlg_B.Selector20_d.VrelLong; |
| 22592 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objXPos = |
| 22593 | fusionAlg_B.Selector20_d.DistLong; |
| 22594 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objYPos = |
| 22595 | fusionAlg_B.Selector20_d.DistLat; |
| 22596 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objID = |
| 22597 | fusionAlg_B.DataTypeConversion_c4t; |
| 22598 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objUpdateFlag = |
| 22599 | fusionAlg_B.Switch_kgw; |
| 22600 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objValidFlag = |
| 22601 | fusionAlg_B.Switch_kgw; |
| 22602 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objType = |
| 22603 | fusionAlg_P_g.Constant9_Value_l5; |
| 22604 | fusionAlg_B.BusCreator_o.radarObj.radar_28_obj.objMeasFlag = |
| 22605 | fusionAlg_P_g.Constant10_Value_fi; |
| 22606 | |
| 22607 | /* Selector: '<S55>/Selector21' incorporates: |
| 22608 | * Constant: '<S55>/Constant28' |
| 22609 | */ |
| 22610 | fusionAlg_B.Selector21_l = rtu_Radar308_Info_st-> |
| 22611 | leftRearRadar_General[fusionAlg_P_g.Constant28_Value_b]; |
| 22612 | |
| 22613 | /* DataTypeConversion: '<S78>/Data Type Conversion' */ |
| 22614 | tmp = (real32_T)floor(fusionAlg_B.Selector21_l.ID); |
| 22615 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22616 | tmp = 0.0F; |
| 22617 | } else { |
| 22618 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22619 | } |
| 22620 | |
| 22621 | fusionAlg_B.DataTypeConversion_bw = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 22622 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22623 | |
| 22624 | /* End of DataTypeConversion: '<S78>/Data Type Conversion' */ |
| 22625 | |
| 22626 | /* Switch: '<S78>/Switch' incorporates: |
| 22627 | * Constant: '<S78>/Constant7' |
| 22628 | * Constant: '<S78>/Constant8' |
| 22629 | */ |
| 22630 | if (fusionAlg_B.DataTypeConversion_bw > fusionAlg_P_g.Switch_Threshold_ch) { |
| 22631 | fusionAlg_B.Switch_oet = fusionAlg_P_g.Constant7_Value_mdx; |
| 22632 | } else { |
| 22633 | fusionAlg_B.Switch_oet = fusionAlg_P_g.Constant8_Value_jn; |
| 22634 | } |
| 22635 | |
| 22636 | /* End of Switch: '<S78>/Switch' */ |
| 22637 | |
| 22638 | /* DataTypeConversion: '<S78>/Data Type Conversion1' */ |
| 22639 | tmp = (real32_T)floor(fusionAlg_B.Selector21_l.DynProp); |
| 22640 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22641 | tmp = 0.0F; |
| 22642 | } else { |
| 22643 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22644 | } |
| 22645 | |
| 22646 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objMotionPattern = (uint8_T) |
| 22647 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22648 | tmp); |
| 22649 | |
| 22650 | /* End of DataTypeConversion: '<S78>/Data Type Conversion1' */ |
| 22651 | |
| 22652 | /* BusCreator: '<S78>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22653 | * Constant: '<S78>/Constant' |
| 22654 | * Constant: '<S78>/Constant1' |
| 22655 | */ |
| 22656 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.reserved.reserved1 = |
| 22657 | fusionAlg_P_g.Constant_Value_an; |
| 22658 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.reserved.reserved0 = |
| 22659 | fusionAlg_P_g.Constant1_Value_le; |
| 22660 | |
| 22661 | /* BusCreator: '<S78>/Bus Creator1' incorporates: |
| 22662 | * Constant: '<S78>/Constant10' |
| 22663 | * Constant: '<S78>/Constant2' |
| 22664 | * Constant: '<S78>/Constant3' |
| 22665 | * Constant: '<S78>/Constant4' |
| 22666 | * Constant: '<S78>/Constant5' |
| 22667 | * Constant: '<S78>/Constant6' |
| 22668 | * Constant: '<S78>/Constant9' |
| 22669 | */ |
| 22670 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objObstacleProb = |
| 22671 | fusionAlg_B.Selector21_l.RCS; |
| 22672 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objXPos_Stdev = |
| 22673 | fusionAlg_P_g.Constant2_Value_gh; |
| 22674 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objYPos_Stdev = |
| 22675 | fusionAlg_P_g.Constant3_Value_av; |
| 22676 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objXVelRel_Stdev = |
| 22677 | fusionAlg_P_g.Constant4_Value_do; |
| 22678 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objXAccRel = |
| 22679 | fusionAlg_P_g.Constant5_Value_nr; |
| 22680 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objExstProb = |
| 22681 | fusionAlg_P_g.Constant6_Value_lv; |
| 22682 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objYVelRel = |
| 22683 | fusionAlg_B.Selector21_l.VrelLat; |
| 22684 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objXVelRel = |
| 22685 | fusionAlg_B.Selector21_l.VrelLong; |
| 22686 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objXPos = |
| 22687 | fusionAlg_B.Selector21_l.DistLong; |
| 22688 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objYPos = |
| 22689 | fusionAlg_B.Selector21_l.DistLat; |
| 22690 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objID = |
| 22691 | fusionAlg_B.DataTypeConversion_bw; |
| 22692 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objUpdateFlag = |
| 22693 | fusionAlg_B.Switch_oet; |
| 22694 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objValidFlag = |
| 22695 | fusionAlg_B.Switch_oet; |
| 22696 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objType = |
| 22697 | fusionAlg_P_g.Constant9_Value_dg; |
| 22698 | fusionAlg_B.BusCreator_o.radarObj.radar_29_obj.objMeasFlag = |
| 22699 | fusionAlg_P_g.Constant10_Value_jy; |
| 22700 | |
| 22701 | /* Selector: '<S55>/Selector22' incorporates: |
| 22702 | * Constant: '<S55>/Constant29' |
| 22703 | */ |
| 22704 | fusionAlg_B.Selector22_j = rtu_Radar308_Info_st-> |
| 22705 | leftRearRadar_General[fusionAlg_P_g.Constant29_Value_e]; |
| 22706 | |
| 22707 | /* DataTypeConversion: '<S80>/Data Type Conversion' */ |
| 22708 | tmp = (real32_T)floor(fusionAlg_B.Selector22_j.ID); |
| 22709 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22710 | tmp = 0.0F; |
| 22711 | } else { |
| 22712 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22713 | } |
| 22714 | |
| 22715 | fusionAlg_B.DataTypeConversion_ff = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 22716 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22717 | |
| 22718 | /* End of DataTypeConversion: '<S80>/Data Type Conversion' */ |
| 22719 | |
| 22720 | /* Switch: '<S80>/Switch' incorporates: |
| 22721 | * Constant: '<S80>/Constant7' |
| 22722 | * Constant: '<S80>/Constant8' |
| 22723 | */ |
| 22724 | if (fusionAlg_B.DataTypeConversion_ff > fusionAlg_P_g.Switch_Threshold_cx) { |
| 22725 | fusionAlg_B.Switch_ag = fusionAlg_P_g.Constant7_Value_bi; |
| 22726 | } else { |
| 22727 | fusionAlg_B.Switch_ag = fusionAlg_P_g.Constant8_Value_hu; |
| 22728 | } |
| 22729 | |
| 22730 | /* End of Switch: '<S80>/Switch' */ |
| 22731 | |
| 22732 | /* DataTypeConversion: '<S80>/Data Type Conversion1' */ |
| 22733 | tmp = (real32_T)floor(fusionAlg_B.Selector22_j.DynProp); |
| 22734 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22735 | tmp = 0.0F; |
| 22736 | } else { |
| 22737 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22738 | } |
| 22739 | |
| 22740 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objMotionPattern = (uint8_T) |
| 22741 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22742 | tmp); |
| 22743 | |
| 22744 | /* End of DataTypeConversion: '<S80>/Data Type Conversion1' */ |
| 22745 | |
| 22746 | /* BusCreator: '<S80>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22747 | * Constant: '<S80>/Constant' |
| 22748 | * Constant: '<S80>/Constant1' |
| 22749 | */ |
| 22750 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.reserved.reserved1 = |
| 22751 | fusionAlg_P_g.Constant_Value_e2x; |
| 22752 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.reserved.reserved0 = |
| 22753 | fusionAlg_P_g.Constant1_Value_dyy; |
| 22754 | |
| 22755 | /* BusCreator: '<S80>/Bus Creator1' incorporates: |
| 22756 | * Constant: '<S80>/Constant10' |
| 22757 | * Constant: '<S80>/Constant2' |
| 22758 | * Constant: '<S80>/Constant3' |
| 22759 | * Constant: '<S80>/Constant4' |
| 22760 | * Constant: '<S80>/Constant5' |
| 22761 | * Constant: '<S80>/Constant6' |
| 22762 | * Constant: '<S80>/Constant9' |
| 22763 | */ |
| 22764 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objObstacleProb = |
| 22765 | fusionAlg_B.Selector22_j.RCS; |
| 22766 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objXPos_Stdev = |
| 22767 | fusionAlg_P_g.Constant2_Value_ok; |
| 22768 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objYPos_Stdev = |
| 22769 | fusionAlg_P_g.Constant3_Value_d2; |
| 22770 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objXVelRel_Stdev = |
| 22771 | fusionAlg_P_g.Constant4_Value_cy; |
| 22772 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objXAccRel = |
| 22773 | fusionAlg_P_g.Constant5_Value_pa; |
| 22774 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objExstProb = |
| 22775 | fusionAlg_P_g.Constant6_Value_lq; |
| 22776 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objYVelRel = |
| 22777 | fusionAlg_B.Selector22_j.VrelLat; |
| 22778 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objXVelRel = |
| 22779 | fusionAlg_B.Selector22_j.VrelLong; |
| 22780 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objXPos = |
| 22781 | fusionAlg_B.Selector22_j.DistLong; |
| 22782 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objYPos = |
| 22783 | fusionAlg_B.Selector22_j.DistLat; |
| 22784 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objID = |
| 22785 | fusionAlg_B.DataTypeConversion_ff; |
| 22786 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objUpdateFlag = |
| 22787 | fusionAlg_B.Switch_ag; |
| 22788 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objValidFlag = |
| 22789 | fusionAlg_B.Switch_ag; |
| 22790 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objType = |
| 22791 | fusionAlg_P_g.Constant9_Value_pz; |
| 22792 | fusionAlg_B.BusCreator_o.radarObj.radar_30_obj.objMeasFlag = |
| 22793 | fusionAlg_P_g.Constant10_Value_h3; |
| 22794 | |
| 22795 | /* Selector: '<S55>/Selector23' incorporates: |
| 22796 | * Constant: '<S55>/Constant30' |
| 22797 | */ |
| 22798 | fusionAlg_B.Selector23_e = rtu_Radar308_Info_st-> |
| 22799 | leftRearRadar_General[fusionAlg_P_g.Constant30_Value_j]; |
| 22800 | |
| 22801 | /* DataTypeConversion: '<S81>/Data Type Conversion' */ |
| 22802 | tmp = (real32_T)floor(fusionAlg_B.Selector23_e.ID); |
| 22803 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22804 | tmp = 0.0F; |
| 22805 | } else { |
| 22806 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22807 | } |
| 22808 | |
| 22809 | fusionAlg_B.DataTypeConversion_fr = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 22810 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22811 | |
| 22812 | /* End of DataTypeConversion: '<S81>/Data Type Conversion' */ |
| 22813 | |
| 22814 | /* Switch: '<S81>/Switch' incorporates: |
| 22815 | * Constant: '<S81>/Constant7' |
| 22816 | * Constant: '<S81>/Constant8' |
| 22817 | */ |
| 22818 | if (fusionAlg_B.DataTypeConversion_fr > fusionAlg_P_g.Switch_Threshold_e1) { |
| 22819 | fusionAlg_B.Switch_ke2 = fusionAlg_P_g.Constant7_Value_f0; |
| 22820 | } else { |
| 22821 | fusionAlg_B.Switch_ke2 = fusionAlg_P_g.Constant8_Value_pt; |
| 22822 | } |
| 22823 | |
| 22824 | /* End of Switch: '<S81>/Switch' */ |
| 22825 | |
| 22826 | /* DataTypeConversion: '<S81>/Data Type Conversion1' */ |
| 22827 | tmp = (real32_T)floor(fusionAlg_B.Selector23_e.DynProp); |
| 22828 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22829 | tmp = 0.0F; |
| 22830 | } else { |
| 22831 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22832 | } |
| 22833 | |
| 22834 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objMotionPattern = (uint8_T) |
| 22835 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22836 | tmp); |
| 22837 | |
| 22838 | /* End of DataTypeConversion: '<S81>/Data Type Conversion1' */ |
| 22839 | |
| 22840 | /* BusCreator: '<S81>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22841 | * Constant: '<S81>/Constant' |
| 22842 | * Constant: '<S81>/Constant1' |
| 22843 | */ |
| 22844 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.reserved.reserved1 = |
| 22845 | fusionAlg_P_g.Constant_Value_o54; |
| 22846 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.reserved.reserved0 = |
| 22847 | fusionAlg_P_g.Constant1_Value_edv; |
| 22848 | |
| 22849 | /* BusCreator: '<S81>/Bus Creator1' incorporates: |
| 22850 | * Constant: '<S81>/Constant10' |
| 22851 | * Constant: '<S81>/Constant2' |
| 22852 | * Constant: '<S81>/Constant3' |
| 22853 | * Constant: '<S81>/Constant4' |
| 22854 | * Constant: '<S81>/Constant5' |
| 22855 | * Constant: '<S81>/Constant6' |
| 22856 | * Constant: '<S81>/Constant9' |
| 22857 | */ |
| 22858 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objObstacleProb = |
| 22859 | fusionAlg_B.Selector23_e.RCS; |
| 22860 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objXPos_Stdev = |
| 22861 | fusionAlg_P_g.Constant2_Value_ar; |
| 22862 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objYPos_Stdev = |
| 22863 | fusionAlg_P_g.Constant3_Value_lw; |
| 22864 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objXVelRel_Stdev = |
| 22865 | fusionAlg_P_g.Constant4_Value_as; |
| 22866 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objXAccRel = |
| 22867 | fusionAlg_P_g.Constant5_Value_jhj; |
| 22868 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objExstProb = |
| 22869 | fusionAlg_P_g.Constant6_Value_iw; |
| 22870 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objYVelRel = |
| 22871 | fusionAlg_B.Selector23_e.VrelLat; |
| 22872 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objXVelRel = |
| 22873 | fusionAlg_B.Selector23_e.VrelLong; |
| 22874 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objXPos = |
| 22875 | fusionAlg_B.Selector23_e.DistLong; |
| 22876 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objYPos = |
| 22877 | fusionAlg_B.Selector23_e.DistLat; |
| 22878 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objID = |
| 22879 | fusionAlg_B.DataTypeConversion_fr; |
| 22880 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objUpdateFlag = |
| 22881 | fusionAlg_B.Switch_ke2; |
| 22882 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objValidFlag = |
| 22883 | fusionAlg_B.Switch_ke2; |
| 22884 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objType = |
| 22885 | fusionAlg_P_g.Constant9_Value_kg; |
| 22886 | fusionAlg_B.BusCreator_o.radarObj.radar_31_obj.objMeasFlag = |
| 22887 | fusionAlg_P_g.Constant10_Value_nh; |
| 22888 | |
| 22889 | /* Selector: '<S55>/Selector31' incorporates: |
| 22890 | * Constant: '<S55>/Constant31' |
| 22891 | */ |
| 22892 | fusionAlg_B.Selector31_i = rtu_Radar308_Info_st-> |
| 22893 | leftRearRadar_General[fusionAlg_P_g.Constant31_Value_ce]; |
| 22894 | |
| 22895 | /* DataTypeConversion: '<S82>/Data Type Conversion' */ |
| 22896 | tmp = (real32_T)floor(fusionAlg_B.Selector31_i.ID); |
| 22897 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22898 | tmp = 0.0F; |
| 22899 | } else { |
| 22900 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22901 | } |
| 22902 | |
| 22903 | fusionAlg_B.DataTypeConversion_lx = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 22904 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22905 | |
| 22906 | /* End of DataTypeConversion: '<S82>/Data Type Conversion' */ |
| 22907 | |
| 22908 | /* Switch: '<S82>/Switch' incorporates: |
| 22909 | * Constant: '<S82>/Constant7' |
| 22910 | * Constant: '<S82>/Constant8' |
| 22911 | */ |
| 22912 | if (fusionAlg_B.DataTypeConversion_lx > fusionAlg_P_g.Switch_Threshold_fk) { |
| 22913 | fusionAlg_B.Switch_bdl = fusionAlg_P_g.Constant7_Value_aq; |
| 22914 | } else { |
| 22915 | fusionAlg_B.Switch_bdl = fusionAlg_P_g.Constant8_Value_g5; |
| 22916 | } |
| 22917 | |
| 22918 | /* End of Switch: '<S82>/Switch' */ |
| 22919 | |
| 22920 | /* DataTypeConversion: '<S82>/Data Type Conversion1' */ |
| 22921 | tmp = (real32_T)floor(fusionAlg_B.Selector31_i.DynProp); |
| 22922 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22923 | tmp = 0.0F; |
| 22924 | } else { |
| 22925 | tmp = (real32_T)fmod(tmp, 256.0); |
| 22926 | } |
| 22927 | |
| 22928 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objMotionPattern = (uint8_T) |
| 22929 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 22930 | tmp); |
| 22931 | |
| 22932 | /* End of DataTypeConversion: '<S82>/Data Type Conversion1' */ |
| 22933 | |
| 22934 | /* BusCreator: '<S82>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 22935 | * Constant: '<S82>/Constant' |
| 22936 | * Constant: '<S82>/Constant1' |
| 22937 | */ |
| 22938 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.reserved.reserved1 = |
| 22939 | fusionAlg_P_g.Constant_Value_o4; |
| 22940 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.reserved.reserved0 = |
| 22941 | fusionAlg_P_g.Constant1_Value_kf; |
| 22942 | |
| 22943 | /* BusCreator: '<S82>/Bus Creator1' incorporates: |
| 22944 | * Constant: '<S82>/Constant10' |
| 22945 | * Constant: '<S82>/Constant2' |
| 22946 | * Constant: '<S82>/Constant3' |
| 22947 | * Constant: '<S82>/Constant4' |
| 22948 | * Constant: '<S82>/Constant5' |
| 22949 | * Constant: '<S82>/Constant6' |
| 22950 | * Constant: '<S82>/Constant9' |
| 22951 | */ |
| 22952 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objObstacleProb = |
| 22953 | fusionAlg_B.Selector31_i.RCS; |
| 22954 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objXPos_Stdev = |
| 22955 | fusionAlg_P_g.Constant2_Value_dm; |
| 22956 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objYPos_Stdev = |
| 22957 | fusionAlg_P_g.Constant3_Value_f2; |
| 22958 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objXVelRel_Stdev = |
| 22959 | fusionAlg_P_g.Constant4_Value_lx; |
| 22960 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objXAccRel = |
| 22961 | fusionAlg_P_g.Constant5_Value_k1j; |
| 22962 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objExstProb = |
| 22963 | fusionAlg_P_g.Constant6_Value_dp; |
| 22964 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objYVelRel = |
| 22965 | fusionAlg_B.Selector31_i.VrelLat; |
| 22966 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objXVelRel = |
| 22967 | fusionAlg_B.Selector31_i.VrelLong; |
| 22968 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objXPos = |
| 22969 | fusionAlg_B.Selector31_i.DistLong; |
| 22970 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objYPos = |
| 22971 | fusionAlg_B.Selector31_i.DistLat; |
| 22972 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objID = |
| 22973 | fusionAlg_B.DataTypeConversion_lx; |
| 22974 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objUpdateFlag = |
| 22975 | fusionAlg_B.Switch_bdl; |
| 22976 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objValidFlag = |
| 22977 | fusionAlg_B.Switch_bdl; |
| 22978 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objType = |
| 22979 | fusionAlg_P_g.Constant9_Value_fy; |
| 22980 | fusionAlg_B.BusCreator_o.radarObj.radar_32_obj.objMeasFlag = |
| 22981 | fusionAlg_P_g.Constant10_Value_mh; |
| 22982 | |
| 22983 | /* Selector: '<S55>/Selector32' incorporates: |
| 22984 | * Constant: '<S55>/Constant32' |
| 22985 | */ |
| 22986 | fusionAlg_B.Selector32_d = rtu_Radar308_Info_st-> |
| 22987 | leftRearRadar_General[fusionAlg_P_g.Constant32_Value_c]; |
| 22988 | |
| 22989 | /* DataTypeConversion: '<S83>/Data Type Conversion' */ |
| 22990 | tmp = (real32_T)floor(fusionAlg_B.Selector32_d.ID); |
| 22991 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 22992 | tmp = 0.0F; |
| 22993 | } else { |
| 22994 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 22995 | } |
| 22996 | |
| 22997 | fusionAlg_B.DataTypeConversion_c1 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 22998 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 22999 | |
| 23000 | /* End of DataTypeConversion: '<S83>/Data Type Conversion' */ |
| 23001 | |
| 23002 | /* Switch: '<S83>/Switch' incorporates: |
| 23003 | * Constant: '<S83>/Constant7' |
| 23004 | * Constant: '<S83>/Constant8' |
| 23005 | */ |
| 23006 | if (fusionAlg_B.DataTypeConversion_c1 > fusionAlg_P_g.Switch_Threshold_m1) { |
| 23007 | fusionAlg_B.Switch_ek = fusionAlg_P_g.Constant7_Value_ck; |
| 23008 | } else { |
| 23009 | fusionAlg_B.Switch_ek = fusionAlg_P_g.Constant8_Value_ki2; |
| 23010 | } |
| 23011 | |
| 23012 | /* End of Switch: '<S83>/Switch' */ |
| 23013 | |
| 23014 | /* DataTypeConversion: '<S83>/Data Type Conversion1' */ |
| 23015 | tmp = (real32_T)floor(fusionAlg_B.Selector32_d.DynProp); |
| 23016 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23017 | tmp = 0.0F; |
| 23018 | } else { |
| 23019 | tmp = (real32_T)fmod(tmp, 256.0); |
| 23020 | } |
| 23021 | |
| 23022 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objMotionPattern = (uint8_T) |
| 23023 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 23024 | tmp); |
| 23025 | |
| 23026 | /* End of DataTypeConversion: '<S83>/Data Type Conversion1' */ |
| 23027 | |
| 23028 | /* BusCreator: '<S83>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 23029 | * Constant: '<S83>/Constant' |
| 23030 | * Constant: '<S83>/Constant1' |
| 23031 | */ |
| 23032 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.reserved.reserved1 = |
| 23033 | fusionAlg_P_g.Constant_Value_h4j; |
| 23034 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.reserved.reserved0 = |
| 23035 | fusionAlg_P_g.Constant1_Value_ohw; |
| 23036 | |
| 23037 | /* BusCreator: '<S83>/Bus Creator1' incorporates: |
| 23038 | * Constant: '<S83>/Constant10' |
| 23039 | * Constant: '<S83>/Constant2' |
| 23040 | * Constant: '<S83>/Constant3' |
| 23041 | * Constant: '<S83>/Constant4' |
| 23042 | * Constant: '<S83>/Constant5' |
| 23043 | * Constant: '<S83>/Constant6' |
| 23044 | * Constant: '<S83>/Constant9' |
| 23045 | */ |
| 23046 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objObstacleProb = |
| 23047 | fusionAlg_B.Selector32_d.RCS; |
| 23048 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objXPos_Stdev = |
| 23049 | fusionAlg_P_g.Constant2_Value_aw; |
| 23050 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objYPos_Stdev = |
| 23051 | fusionAlg_P_g.Constant3_Value_mq; |
| 23052 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objXVelRel_Stdev = |
| 23053 | fusionAlg_P_g.Constant4_Value_ec; |
| 23054 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objXAccRel = |
| 23055 | fusionAlg_P_g.Constant5_Value_my; |
| 23056 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objExstProb = |
| 23057 | fusionAlg_P_g.Constant6_Value_po; |
| 23058 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objYVelRel = |
| 23059 | fusionAlg_B.Selector32_d.VrelLat; |
| 23060 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objXVelRel = |
| 23061 | fusionAlg_B.Selector32_d.VrelLong; |
| 23062 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objXPos = |
| 23063 | fusionAlg_B.Selector32_d.DistLong; |
| 23064 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objYPos = |
| 23065 | fusionAlg_B.Selector32_d.DistLat; |
| 23066 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objID = |
| 23067 | fusionAlg_B.DataTypeConversion_c1; |
| 23068 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objUpdateFlag = |
| 23069 | fusionAlg_B.Switch_ek; |
| 23070 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objValidFlag = |
| 23071 | fusionAlg_B.Switch_ek; |
| 23072 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objType = |
| 23073 | fusionAlg_P_g.Constant9_Value_phk; |
| 23074 | fusionAlg_B.BusCreator_o.radarObj.radar_33_obj.objMeasFlag = |
| 23075 | fusionAlg_P_g.Constant10_Value_py; |
| 23076 | |
| 23077 | /* Selector: '<S55>/Selector33' incorporates: |
| 23078 | * Constant: '<S55>/Constant33' |
| 23079 | */ |
| 23080 | fusionAlg_B.Selector33_i = rtu_Radar308_Info_st-> |
| 23081 | leftRearRadar_General[fusionAlg_P_g.Constant33_Value_n]; |
| 23082 | |
| 23083 | /* DataTypeConversion: '<S84>/Data Type Conversion' */ |
| 23084 | tmp = (real32_T)floor(fusionAlg_B.Selector33_i.ID); |
| 23085 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23086 | tmp = 0.0F; |
| 23087 | } else { |
| 23088 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 23089 | } |
| 23090 | |
| 23091 | fusionAlg_B.DataTypeConversion_hx = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 23092 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 23093 | |
| 23094 | /* End of DataTypeConversion: '<S84>/Data Type Conversion' */ |
| 23095 | |
| 23096 | /* Switch: '<S84>/Switch' incorporates: |
| 23097 | * Constant: '<S84>/Constant7' |
| 23098 | * Constant: '<S84>/Constant8' |
| 23099 | */ |
| 23100 | if (fusionAlg_B.DataTypeConversion_hx > fusionAlg_P_g.Switch_Threshold_cb) { |
| 23101 | fusionAlg_B.Switch_oz = fusionAlg_P_g.Constant7_Value_ad; |
| 23102 | } else { |
| 23103 | fusionAlg_B.Switch_oz = fusionAlg_P_g.Constant8_Value_iz; |
| 23104 | } |
| 23105 | |
| 23106 | /* End of Switch: '<S84>/Switch' */ |
| 23107 | |
| 23108 | /* DataTypeConversion: '<S84>/Data Type Conversion1' */ |
| 23109 | tmp = (real32_T)floor(fusionAlg_B.Selector33_i.DynProp); |
| 23110 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23111 | tmp = 0.0F; |
| 23112 | } else { |
| 23113 | tmp = (real32_T)fmod(tmp, 256.0); |
| 23114 | } |
| 23115 | |
| 23116 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objMotionPattern = (uint8_T) |
| 23117 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 23118 | tmp); |
| 23119 | |
| 23120 | /* End of DataTypeConversion: '<S84>/Data Type Conversion1' */ |
| 23121 | |
| 23122 | /* BusCreator: '<S84>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 23123 | * Constant: '<S84>/Constant' |
| 23124 | * Constant: '<S84>/Constant1' |
| 23125 | */ |
| 23126 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.reserved.reserved1 = |
| 23127 | fusionAlg_P_g.Constant_Value_ma; |
| 23128 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.reserved.reserved0 = |
| 23129 | fusionAlg_P_g.Constant1_Value_cr2; |
| 23130 | |
| 23131 | /* BusCreator: '<S84>/Bus Creator1' incorporates: |
| 23132 | * Constant: '<S84>/Constant10' |
| 23133 | * Constant: '<S84>/Constant2' |
| 23134 | * Constant: '<S84>/Constant3' |
| 23135 | * Constant: '<S84>/Constant4' |
| 23136 | * Constant: '<S84>/Constant5' |
| 23137 | * Constant: '<S84>/Constant6' |
| 23138 | * Constant: '<S84>/Constant9' |
| 23139 | */ |
| 23140 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objObstacleProb = |
| 23141 | fusionAlg_B.Selector33_i.RCS; |
| 23142 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objXPos_Stdev = |
| 23143 | fusionAlg_P_g.Constant2_Value_b3; |
| 23144 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objYPos_Stdev = |
| 23145 | fusionAlg_P_g.Constant3_Value_l5; |
| 23146 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objXVelRel_Stdev = |
| 23147 | fusionAlg_P_g.Constant4_Value_jn; |
| 23148 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objXAccRel = |
| 23149 | fusionAlg_P_g.Constant5_Value_df; |
| 23150 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objExstProb = |
| 23151 | fusionAlg_P_g.Constant6_Value_ada; |
| 23152 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objYVelRel = |
| 23153 | fusionAlg_B.Selector33_i.VrelLat; |
| 23154 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objXVelRel = |
| 23155 | fusionAlg_B.Selector33_i.VrelLong; |
| 23156 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objXPos = |
| 23157 | fusionAlg_B.Selector33_i.DistLong; |
| 23158 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objYPos = |
| 23159 | fusionAlg_B.Selector33_i.DistLat; |
| 23160 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objID = |
| 23161 | fusionAlg_B.DataTypeConversion_hx; |
| 23162 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objUpdateFlag = |
| 23163 | fusionAlg_B.Switch_oz; |
| 23164 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objValidFlag = |
| 23165 | fusionAlg_B.Switch_oz; |
| 23166 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objType = |
| 23167 | fusionAlg_P_g.Constant9_Value_nh; |
| 23168 | fusionAlg_B.BusCreator_o.radarObj.radar_34_obj.objMeasFlag = |
| 23169 | fusionAlg_P_g.Constant10_Value_kbb; |
| 23170 | |
| 23171 | /* Selector: '<S55>/Selector34' incorporates: |
| 23172 | * Constant: '<S55>/Constant34' |
| 23173 | */ |
| 23174 | fusionAlg_B.Selector34_p = rtu_Radar308_Info_st-> |
| 23175 | leftRearRadar_General[fusionAlg_P_g.Constant34_Value_o]; |
| 23176 | |
| 23177 | /* DataTypeConversion: '<S85>/Data Type Conversion' */ |
| 23178 | tmp = (real32_T)floor(fusionAlg_B.Selector34_p.ID); |
| 23179 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23180 | tmp = 0.0F; |
| 23181 | } else { |
| 23182 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 23183 | } |
| 23184 | |
| 23185 | fusionAlg_B.DataTypeConversion_op = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 23186 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 23187 | |
| 23188 | /* End of DataTypeConversion: '<S85>/Data Type Conversion' */ |
| 23189 | |
| 23190 | /* Switch: '<S85>/Switch' incorporates: |
| 23191 | * Constant: '<S85>/Constant7' |
| 23192 | * Constant: '<S85>/Constant8' |
| 23193 | */ |
| 23194 | if (fusionAlg_B.DataTypeConversion_op > fusionAlg_P_g.Switch_Threshold_as) { |
| 23195 | fusionAlg_B.Switch_lw = fusionAlg_P_g.Constant7_Value_dz; |
| 23196 | } else { |
| 23197 | fusionAlg_B.Switch_lw = fusionAlg_P_g.Constant8_Value_ins; |
| 23198 | } |
| 23199 | |
| 23200 | /* End of Switch: '<S85>/Switch' */ |
| 23201 | |
| 23202 | /* DataTypeConversion: '<S85>/Data Type Conversion1' */ |
| 23203 | tmp = (real32_T)floor(fusionAlg_B.Selector34_p.DynProp); |
| 23204 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23205 | tmp = 0.0F; |
| 23206 | } else { |
| 23207 | tmp = (real32_T)fmod(tmp, 256.0); |
| 23208 | } |
| 23209 | |
| 23210 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objMotionPattern = (uint8_T) |
| 23211 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 23212 | tmp); |
| 23213 | |
| 23214 | /* End of DataTypeConversion: '<S85>/Data Type Conversion1' */ |
| 23215 | |
| 23216 | /* BusCreator: '<S85>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 23217 | * Constant: '<S85>/Constant' |
| 23218 | * Constant: '<S85>/Constant1' |
| 23219 | */ |
| 23220 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.reserved.reserved1 = |
| 23221 | fusionAlg_P_g.Constant_Value_l4; |
| 23222 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.reserved.reserved0 = |
| 23223 | fusionAlg_P_g.Constant1_Value_ec; |
| 23224 | |
| 23225 | /* BusCreator: '<S85>/Bus Creator1' incorporates: |
| 23226 | * Constant: '<S85>/Constant10' |
| 23227 | * Constant: '<S85>/Constant2' |
| 23228 | * Constant: '<S85>/Constant3' |
| 23229 | * Constant: '<S85>/Constant4' |
| 23230 | * Constant: '<S85>/Constant5' |
| 23231 | * Constant: '<S85>/Constant6' |
| 23232 | * Constant: '<S85>/Constant9' |
| 23233 | */ |
| 23234 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objObstacleProb = |
| 23235 | fusionAlg_B.Selector34_p.RCS; |
| 23236 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objXPos_Stdev = |
| 23237 | fusionAlg_P_g.Constant2_Value_b32; |
| 23238 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objYPos_Stdev = |
| 23239 | fusionAlg_P_g.Constant3_Value_lp; |
| 23240 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objXVelRel_Stdev = |
| 23241 | fusionAlg_P_g.Constant4_Value_d0; |
| 23242 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objXAccRel = |
| 23243 | fusionAlg_P_g.Constant5_Value_nf; |
| 23244 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objExstProb = |
| 23245 | fusionAlg_P_g.Constant6_Value_f0l; |
| 23246 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objYVelRel = |
| 23247 | fusionAlg_B.Selector34_p.VrelLat; |
| 23248 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objXVelRel = |
| 23249 | fusionAlg_B.Selector34_p.VrelLong; |
| 23250 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objXPos = |
| 23251 | fusionAlg_B.Selector34_p.DistLong; |
| 23252 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objYPos = |
| 23253 | fusionAlg_B.Selector34_p.DistLat; |
| 23254 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objID = |
| 23255 | fusionAlg_B.DataTypeConversion_op; |
| 23256 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objUpdateFlag = |
| 23257 | fusionAlg_B.Switch_lw; |
| 23258 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objValidFlag = |
| 23259 | fusionAlg_B.Switch_lw; |
| 23260 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objType = |
| 23261 | fusionAlg_P_g.Constant9_Value_oj; |
| 23262 | fusionAlg_B.BusCreator_o.radarObj.radar_35_obj.objMeasFlag = |
| 23263 | fusionAlg_P_g.Constant10_Value_gi; |
| 23264 | |
| 23265 | /* Selector: '<S55>/Selector35' incorporates: |
| 23266 | * Constant: '<S55>/Constant35' |
| 23267 | */ |
| 23268 | fusionAlg_B.Selector35_m = rtu_Radar308_Info_st-> |
| 23269 | leftRearRadar_General[fusionAlg_P_g.Constant35_Value_j]; |
| 23270 | |
| 23271 | /* DataTypeConversion: '<S86>/Data Type Conversion' */ |
| 23272 | tmp = (real32_T)floor(fusionAlg_B.Selector35_m.ID); |
| 23273 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23274 | tmp = 0.0F; |
| 23275 | } else { |
| 23276 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 23277 | } |
| 23278 | |
| 23279 | fusionAlg_B.DataTypeConversion_kl = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 23280 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 23281 | |
| 23282 | /* End of DataTypeConversion: '<S86>/Data Type Conversion' */ |
| 23283 | |
| 23284 | /* Switch: '<S86>/Switch' incorporates: |
| 23285 | * Constant: '<S86>/Constant7' |
| 23286 | * Constant: '<S86>/Constant8' |
| 23287 | */ |
| 23288 | if (fusionAlg_B.DataTypeConversion_kl > fusionAlg_P_g.Switch_Threshold_hr) { |
| 23289 | fusionAlg_B.Switch_b0v = fusionAlg_P_g.Constant7_Value_dgc; |
| 23290 | } else { |
| 23291 | fusionAlg_B.Switch_b0v = fusionAlg_P_g.Constant8_Value_ko; |
| 23292 | } |
| 23293 | |
| 23294 | /* End of Switch: '<S86>/Switch' */ |
| 23295 | |
| 23296 | /* DataTypeConversion: '<S86>/Data Type Conversion1' */ |
| 23297 | tmp = (real32_T)floor(fusionAlg_B.Selector35_m.DynProp); |
| 23298 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23299 | tmp = 0.0F; |
| 23300 | } else { |
| 23301 | tmp = (real32_T)fmod(tmp, 256.0); |
| 23302 | } |
| 23303 | |
| 23304 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objMotionPattern = (uint8_T) |
| 23305 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 23306 | tmp); |
| 23307 | |
| 23308 | /* End of DataTypeConversion: '<S86>/Data Type Conversion1' */ |
| 23309 | |
| 23310 | /* BusCreator: '<S86>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 23311 | * Constant: '<S86>/Constant' |
| 23312 | * Constant: '<S86>/Constant1' |
| 23313 | */ |
| 23314 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.reserved.reserved1 = |
| 23315 | fusionAlg_P_g.Constant_Value_eri; |
| 23316 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.reserved.reserved0 = |
| 23317 | fusionAlg_P_g.Constant1_Value_c4w; |
| 23318 | |
| 23319 | /* BusCreator: '<S86>/Bus Creator1' incorporates: |
| 23320 | * Constant: '<S86>/Constant10' |
| 23321 | * Constant: '<S86>/Constant2' |
| 23322 | * Constant: '<S86>/Constant3' |
| 23323 | * Constant: '<S86>/Constant4' |
| 23324 | * Constant: '<S86>/Constant5' |
| 23325 | * Constant: '<S86>/Constant6' |
| 23326 | * Constant: '<S86>/Constant9' |
| 23327 | */ |
| 23328 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objObstacleProb = |
| 23329 | fusionAlg_B.Selector35_m.RCS; |
| 23330 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objXPos_Stdev = |
| 23331 | fusionAlg_P_g.Constant2_Value_a5; |
| 23332 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objYPos_Stdev = |
| 23333 | fusionAlg_P_g.Constant3_Value_cdn; |
| 23334 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objXVelRel_Stdev = |
| 23335 | fusionAlg_P_g.Constant4_Value_ant; |
| 23336 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objXAccRel = |
| 23337 | fusionAlg_P_g.Constant5_Value_pk; |
| 23338 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objExstProb = |
| 23339 | fusionAlg_P_g.Constant6_Value_me; |
| 23340 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objYVelRel = |
| 23341 | fusionAlg_B.Selector35_m.VrelLat; |
| 23342 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objXVelRel = |
| 23343 | fusionAlg_B.Selector35_m.VrelLong; |
| 23344 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objXPos = |
| 23345 | fusionAlg_B.Selector35_m.DistLong; |
| 23346 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objYPos = |
| 23347 | fusionAlg_B.Selector35_m.DistLat; |
| 23348 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objID = |
| 23349 | fusionAlg_B.DataTypeConversion_kl; |
| 23350 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objUpdateFlag = |
| 23351 | fusionAlg_B.Switch_b0v; |
| 23352 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objValidFlag = |
| 23353 | fusionAlg_B.Switch_b0v; |
| 23354 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objType = |
| 23355 | fusionAlg_P_g.Constant9_Value_pni; |
| 23356 | fusionAlg_B.BusCreator_o.radarObj.radar_36_obj.objMeasFlag = |
| 23357 | fusionAlg_P_g.Constant10_Value_py2; |
| 23358 | |
| 23359 | /* Selector: '<S55>/Selector36' incorporates: |
| 23360 | * Constant: '<S55>/Constant36' |
| 23361 | */ |
| 23362 | fusionAlg_B.Selector36_b = rtu_Radar308_Info_st-> |
| 23363 | leftRearRadar_General[fusionAlg_P_g.Constant36_Value_n]; |
| 23364 | |
| 23365 | /* DataTypeConversion: '<S87>/Data Type Conversion' */ |
| 23366 | tmp = (real32_T)floor(fusionAlg_B.Selector36_b.ID); |
| 23367 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23368 | tmp = 0.0F; |
| 23369 | } else { |
| 23370 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 23371 | } |
| 23372 | |
| 23373 | fusionAlg_B.DataTypeConversion_a5 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 23374 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 23375 | |
| 23376 | /* End of DataTypeConversion: '<S87>/Data Type Conversion' */ |
| 23377 | |
| 23378 | /* Switch: '<S87>/Switch' incorporates: |
| 23379 | * Constant: '<S87>/Constant7' |
| 23380 | * Constant: '<S87>/Constant8' |
| 23381 | */ |
| 23382 | if (fusionAlg_B.DataTypeConversion_a5 > fusionAlg_P_g.Switch_Threshold_gt) { |
| 23383 | fusionAlg_B.Switch_ov = fusionAlg_P_g.Constant7_Value_mf2; |
| 23384 | } else { |
| 23385 | fusionAlg_B.Switch_ov = fusionAlg_P_g.Constant8_Value_nf; |
| 23386 | } |
| 23387 | |
| 23388 | /* End of Switch: '<S87>/Switch' */ |
| 23389 | |
| 23390 | /* DataTypeConversion: '<S87>/Data Type Conversion1' */ |
| 23391 | tmp = (real32_T)floor(fusionAlg_B.Selector36_b.DynProp); |
| 23392 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23393 | tmp = 0.0F; |
| 23394 | } else { |
| 23395 | tmp = (real32_T)fmod(tmp, 256.0); |
| 23396 | } |
| 23397 | |
| 23398 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objMotionPattern = (uint8_T) |
| 23399 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 23400 | tmp); |
| 23401 | |
| 23402 | /* End of DataTypeConversion: '<S87>/Data Type Conversion1' */ |
| 23403 | |
| 23404 | /* BusCreator: '<S87>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 23405 | * Constant: '<S87>/Constant' |
| 23406 | * Constant: '<S87>/Constant1' |
| 23407 | */ |
| 23408 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.reserved.reserved1 = |
| 23409 | fusionAlg_P_g.Constant_Value_gl; |
| 23410 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.reserved.reserved0 = |
| 23411 | fusionAlg_P_g.Constant1_Value_b5; |
| 23412 | |
| 23413 | /* BusCreator: '<S87>/Bus Creator1' incorporates: |
| 23414 | * Constant: '<S87>/Constant10' |
| 23415 | * Constant: '<S87>/Constant2' |
| 23416 | * Constant: '<S87>/Constant3' |
| 23417 | * Constant: '<S87>/Constant4' |
| 23418 | * Constant: '<S87>/Constant5' |
| 23419 | * Constant: '<S87>/Constant6' |
| 23420 | * Constant: '<S87>/Constant9' |
| 23421 | */ |
| 23422 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objObstacleProb = |
| 23423 | fusionAlg_B.Selector36_b.RCS; |
| 23424 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objXPos_Stdev = |
| 23425 | fusionAlg_P_g.Constant2_Value_go; |
| 23426 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objYPos_Stdev = |
| 23427 | fusionAlg_P_g.Constant3_Value_jq; |
| 23428 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objXVelRel_Stdev = |
| 23429 | fusionAlg_P_g.Constant4_Value_dq; |
| 23430 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objXAccRel = |
| 23431 | fusionAlg_P_g.Constant5_Value_ma; |
| 23432 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objExstProb = |
| 23433 | fusionAlg_P_g.Constant6_Value_db; |
| 23434 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objYVelRel = |
| 23435 | fusionAlg_B.Selector36_b.VrelLat; |
| 23436 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objXVelRel = |
| 23437 | fusionAlg_B.Selector36_b.VrelLong; |
| 23438 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objXPos = |
| 23439 | fusionAlg_B.Selector36_b.DistLong; |
| 23440 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objYPos = |
| 23441 | fusionAlg_B.Selector36_b.DistLat; |
| 23442 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objID = |
| 23443 | fusionAlg_B.DataTypeConversion_a5; |
| 23444 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objUpdateFlag = |
| 23445 | fusionAlg_B.Switch_ov; |
| 23446 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objValidFlag = |
| 23447 | fusionAlg_B.Switch_ov; |
| 23448 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objType = |
| 23449 | fusionAlg_P_g.Constant9_Value_fh; |
| 23450 | fusionAlg_B.BusCreator_o.radarObj.radar_37_obj.objMeasFlag = |
| 23451 | fusionAlg_P_g.Constant10_Value_p3; |
| 23452 | |
| 23453 | /* Selector: '<S55>/Selector37' incorporates: |
| 23454 | * Constant: '<S55>/Constant37' |
| 23455 | */ |
| 23456 | fusionAlg_B.Selector37_oy = rtu_Radar308_Info_st-> |
| 23457 | leftRearRadar_General[fusionAlg_P_g.Constant37_Value_i]; |
| 23458 | |
| 23459 | /* DataTypeConversion: '<S88>/Data Type Conversion' */ |
| 23460 | tmp = (real32_T)floor(fusionAlg_B.Selector37_oy.ID); |
| 23461 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23462 | tmp = 0.0F; |
| 23463 | } else { |
| 23464 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 23465 | } |
| 23466 | |
| 23467 | fusionAlg_B.DataTypeConversion_nr5 = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 23468 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 23469 | |
| 23470 | /* End of DataTypeConversion: '<S88>/Data Type Conversion' */ |
| 23471 | |
| 23472 | /* Switch: '<S88>/Switch' incorporates: |
| 23473 | * Constant: '<S88>/Constant7' |
| 23474 | * Constant: '<S88>/Constant8' |
| 23475 | */ |
| 23476 | if (fusionAlg_B.DataTypeConversion_nr5 > fusionAlg_P_g.Switch_Threshold_nt) { |
| 23477 | fusionAlg_B.Switch_gz = fusionAlg_P_g.Constant7_Value_de; |
| 23478 | } else { |
| 23479 | fusionAlg_B.Switch_gz = fusionAlg_P_g.Constant8_Value_ca; |
| 23480 | } |
| 23481 | |
| 23482 | /* End of Switch: '<S88>/Switch' */ |
| 23483 | |
| 23484 | /* DataTypeConversion: '<S88>/Data Type Conversion1' */ |
| 23485 | tmp = (real32_T)floor(fusionAlg_B.Selector37_oy.DynProp); |
| 23486 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23487 | tmp = 0.0F; |
| 23488 | } else { |
| 23489 | tmp = (real32_T)fmod(tmp, 256.0); |
| 23490 | } |
| 23491 | |
| 23492 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objMotionPattern = (uint8_T) |
| 23493 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 23494 | tmp); |
| 23495 | |
| 23496 | /* End of DataTypeConversion: '<S88>/Data Type Conversion1' */ |
| 23497 | |
| 23498 | /* BusCreator: '<S88>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 23499 | * Constant: '<S88>/Constant' |
| 23500 | * Constant: '<S88>/Constant1' |
| 23501 | */ |
| 23502 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.reserved.reserved1 = |
| 23503 | fusionAlg_P_g.Constant_Value_lof5; |
| 23504 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.reserved.reserved0 = |
| 23505 | fusionAlg_P_g.Constant1_Value_lm; |
| 23506 | |
| 23507 | /* BusCreator: '<S88>/Bus Creator1' incorporates: |
| 23508 | * Constant: '<S88>/Constant10' |
| 23509 | * Constant: '<S88>/Constant2' |
| 23510 | * Constant: '<S88>/Constant3' |
| 23511 | * Constant: '<S88>/Constant4' |
| 23512 | * Constant: '<S88>/Constant5' |
| 23513 | * Constant: '<S88>/Constant6' |
| 23514 | * Constant: '<S88>/Constant9' |
| 23515 | */ |
| 23516 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objObstacleProb = |
| 23517 | fusionAlg_B.Selector37_oy.RCS; |
| 23518 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objXPos_Stdev = |
| 23519 | fusionAlg_P_g.Constant2_Value_aew; |
| 23520 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objYPos_Stdev = |
| 23521 | fusionAlg_P_g.Constant3_Value_lxx; |
| 23522 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objXVelRel_Stdev = |
| 23523 | fusionAlg_P_g.Constant4_Value_fi; |
| 23524 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objXAccRel = |
| 23525 | fusionAlg_P_g.Constant5_Value_au; |
| 23526 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objExstProb = |
| 23527 | fusionAlg_P_g.Constant6_Value_en; |
| 23528 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objYVelRel = |
| 23529 | fusionAlg_B.Selector37_oy.VrelLat; |
| 23530 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objXVelRel = |
| 23531 | fusionAlg_B.Selector37_oy.VrelLong; |
| 23532 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objXPos = |
| 23533 | fusionAlg_B.Selector37_oy.DistLong; |
| 23534 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objYPos = |
| 23535 | fusionAlg_B.Selector37_oy.DistLat; |
| 23536 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objID = |
| 23537 | fusionAlg_B.DataTypeConversion_nr5; |
| 23538 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objUpdateFlag = |
| 23539 | fusionAlg_B.Switch_gz; |
| 23540 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objValidFlag = |
| 23541 | fusionAlg_B.Switch_gz; |
| 23542 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objType = |
| 23543 | fusionAlg_P_g.Constant9_Value_lkt; |
| 23544 | fusionAlg_B.BusCreator_o.radarObj.radar_38_obj.objMeasFlag = |
| 23545 | fusionAlg_P_g.Constant10_Value_h0; |
| 23546 | |
| 23547 | /* Selector: '<S55>/Selector38' incorporates: |
| 23548 | * Constant: '<S55>/Constant38' |
| 23549 | */ |
| 23550 | fusionAlg_B.Selector38_g = rtu_Radar308_Info_st-> |
| 23551 | leftRearRadar_General[fusionAlg_P_g.Constant38_Value_p]; |
| 23552 | |
| 23553 | /* DataTypeConversion: '<S89>/Data Type Conversion' */ |
| 23554 | tmp = (real32_T)floor(fusionAlg_B.Selector38_g.ID); |
| 23555 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23556 | tmp = 0.0F; |
| 23557 | } else { |
| 23558 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 23559 | } |
| 23560 | |
| 23561 | fusionAlg_B.DataTypeConversion_fep = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 23562 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 23563 | |
| 23564 | /* End of DataTypeConversion: '<S89>/Data Type Conversion' */ |
| 23565 | |
| 23566 | /* Switch: '<S89>/Switch' incorporates: |
| 23567 | * Constant: '<S89>/Constant7' |
| 23568 | * Constant: '<S89>/Constant8' |
| 23569 | */ |
| 23570 | if (fusionAlg_B.DataTypeConversion_fep > fusionAlg_P_g.Switch_Threshold_cj) { |
| 23571 | fusionAlg_B.Switch_bt = fusionAlg_P_g.Constant7_Value_ao; |
| 23572 | } else { |
| 23573 | fusionAlg_B.Switch_bt = fusionAlg_P_g.Constant8_Value_co; |
| 23574 | } |
| 23575 | |
| 23576 | /* End of Switch: '<S89>/Switch' */ |
| 23577 | |
| 23578 | /* DataTypeConversion: '<S89>/Data Type Conversion1' */ |
| 23579 | tmp = (real32_T)floor(fusionAlg_B.Selector38_g.DynProp); |
| 23580 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23581 | tmp = 0.0F; |
| 23582 | } else { |
| 23583 | tmp = (real32_T)fmod(tmp, 256.0); |
| 23584 | } |
| 23585 | |
| 23586 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objMotionPattern = (uint8_T) |
| 23587 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 23588 | tmp); |
| 23589 | |
| 23590 | /* End of DataTypeConversion: '<S89>/Data Type Conversion1' */ |
| 23591 | |
| 23592 | /* BusCreator: '<S89>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 23593 | * Constant: '<S89>/Constant' |
| 23594 | * Constant: '<S89>/Constant1' |
| 23595 | */ |
| 23596 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.reserved.reserved1 = |
| 23597 | fusionAlg_P_g.Constant_Value_c2; |
| 23598 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.reserved.reserved0 = |
| 23599 | fusionAlg_P_g.Constant1_Value_ie; |
| 23600 | |
| 23601 | /* BusCreator: '<S89>/Bus Creator1' incorporates: |
| 23602 | * Constant: '<S89>/Constant10' |
| 23603 | * Constant: '<S89>/Constant2' |
| 23604 | * Constant: '<S89>/Constant3' |
| 23605 | * Constant: '<S89>/Constant4' |
| 23606 | * Constant: '<S89>/Constant5' |
| 23607 | * Constant: '<S89>/Constant6' |
| 23608 | * Constant: '<S89>/Constant9' |
| 23609 | */ |
| 23610 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objObstacleProb = |
| 23611 | fusionAlg_B.Selector38_g.RCS; |
| 23612 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objXPos_Stdev = |
| 23613 | fusionAlg_P_g.Constant2_Value_kab; |
| 23614 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objYPos_Stdev = |
| 23615 | fusionAlg_P_g.Constant3_Value_d4; |
| 23616 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objXVelRel_Stdev = |
| 23617 | fusionAlg_P_g.Constant4_Value_dmd; |
| 23618 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objXAccRel = |
| 23619 | fusionAlg_P_g.Constant5_Value_gr; |
| 23620 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objExstProb = |
| 23621 | fusionAlg_P_g.Constant6_Value_ft; |
| 23622 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objYVelRel = |
| 23623 | fusionAlg_B.Selector38_g.VrelLat; |
| 23624 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objXVelRel = |
| 23625 | fusionAlg_B.Selector38_g.VrelLong; |
| 23626 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objXPos = |
| 23627 | fusionAlg_B.Selector38_g.DistLong; |
| 23628 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objYPos = |
| 23629 | fusionAlg_B.Selector38_g.DistLat; |
| 23630 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objID = |
| 23631 | fusionAlg_B.DataTypeConversion_fep; |
| 23632 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objUpdateFlag = |
| 23633 | fusionAlg_B.Switch_bt; |
| 23634 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objValidFlag = |
| 23635 | fusionAlg_B.Switch_bt; |
| 23636 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objType = |
| 23637 | fusionAlg_P_g.Constant9_Value_ck; |
| 23638 | fusionAlg_B.BusCreator_o.radarObj.radar_39_obj.objMeasFlag = |
| 23639 | fusionAlg_P_g.Constant10_Value_jd; |
| 23640 | |
| 23641 | /* Selector: '<S55>/Selector39' incorporates: |
| 23642 | * Constant: '<S55>/Constant39' |
| 23643 | */ |
| 23644 | fusionAlg_B.Selector39_o = rtu_Radar308_Info_st-> |
| 23645 | leftRearRadar_General[fusionAlg_P_g.Constant39_Value_k]; |
| 23646 | |
| 23647 | /* DataTypeConversion: '<S91>/Data Type Conversion' */ |
| 23648 | tmp = (real32_T)floor(fusionAlg_B.Selector39_o.ID); |
| 23649 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23650 | tmp = 0.0F; |
| 23651 | } else { |
| 23652 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 23653 | } |
| 23654 | |
| 23655 | fusionAlg_B.DataTypeConversion_mkr = (uint16_T)(tmp < 0.0F ? (int32_T) |
| 23656 | (uint16_T)-(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 23657 | |
| 23658 | /* End of DataTypeConversion: '<S91>/Data Type Conversion' */ |
| 23659 | |
| 23660 | /* Switch: '<S91>/Switch' incorporates: |
| 23661 | * Constant: '<S91>/Constant7' |
| 23662 | * Constant: '<S91>/Constant8' |
| 23663 | */ |
| 23664 | if (fusionAlg_B.DataTypeConversion_mkr > fusionAlg_P_g.Switch_Threshold_ar) { |
| 23665 | fusionAlg_B.Switch_ae = fusionAlg_P_g.Constant7_Value_ex; |
| 23666 | } else { |
| 23667 | fusionAlg_B.Switch_ae = fusionAlg_P_g.Constant8_Value_aoc; |
| 23668 | } |
| 23669 | |
| 23670 | /* End of Switch: '<S91>/Switch' */ |
| 23671 | |
| 23672 | /* DataTypeConversion: '<S91>/Data Type Conversion1' */ |
| 23673 | tmp = (real32_T)floor(fusionAlg_B.Selector39_o.DynProp); |
| 23674 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23675 | tmp = 0.0F; |
| 23676 | } else { |
| 23677 | tmp = (real32_T)fmod(tmp, 256.0); |
| 23678 | } |
| 23679 | |
| 23680 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objMotionPattern = (uint8_T) |
| 23681 | (tmp < 0.0F ? (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T) |
| 23682 | tmp); |
| 23683 | |
| 23684 | /* End of DataTypeConversion: '<S91>/Data Type Conversion1' */ |
| 23685 | |
| 23686 | /* BusCreator: '<S91>/BusConversion_InsertedFor_Bus Creator1_at_inport_16' incorporates: |
| 23687 | * Constant: '<S91>/Constant' |
| 23688 | * Constant: '<S91>/Constant1' |
| 23689 | */ |
| 23690 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.reserved.reserved1 = |
| 23691 | fusionAlg_P_g.Constant_Value_e5; |
| 23692 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.reserved.reserved0 = |
| 23693 | fusionAlg_P_g.Constant1_Value_pz; |
| 23694 | |
| 23695 | /* BusCreator: '<S91>/Bus Creator1' incorporates: |
| 23696 | * Constant: '<S91>/Constant10' |
| 23697 | * Constant: '<S91>/Constant2' |
| 23698 | * Constant: '<S91>/Constant3' |
| 23699 | * Constant: '<S91>/Constant4' |
| 23700 | * Constant: '<S91>/Constant5' |
| 23701 | * Constant: '<S91>/Constant6' |
| 23702 | * Constant: '<S91>/Constant9' |
| 23703 | */ |
| 23704 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objObstacleProb = |
| 23705 | fusionAlg_B.Selector39_o.RCS; |
| 23706 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objXPos_Stdev = |
| 23707 | fusionAlg_P_g.Constant2_Value_p0z; |
| 23708 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objYPos_Stdev = |
| 23709 | fusionAlg_P_g.Constant3_Value_gc; |
| 23710 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objXVelRel_Stdev = |
| 23711 | fusionAlg_P_g.Constant4_Value_met; |
| 23712 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objXAccRel = |
| 23713 | fusionAlg_P_g.Constant5_Value_csj; |
| 23714 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objExstProb = |
| 23715 | fusionAlg_P_g.Constant6_Value_gh; |
| 23716 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objYVelRel = |
| 23717 | fusionAlg_B.Selector39_o.VrelLat; |
| 23718 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objXVelRel = |
| 23719 | fusionAlg_B.Selector39_o.VrelLong; |
| 23720 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objXPos = |
| 23721 | fusionAlg_B.Selector39_o.DistLong; |
| 23722 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objYPos = |
| 23723 | fusionAlg_B.Selector39_o.DistLat; |
| 23724 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objID = |
| 23725 | fusionAlg_B.DataTypeConversion_mkr; |
| 23726 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objUpdateFlag = |
| 23727 | fusionAlg_B.Switch_ae; |
| 23728 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objValidFlag = |
| 23729 | fusionAlg_B.Switch_ae; |
| 23730 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objType = |
| 23731 | fusionAlg_P_g.Constant9_Value_n2; |
| 23732 | fusionAlg_B.BusCreator_o.radarObj.radar_40_obj.objMeasFlag = |
| 23733 | fusionAlg_P_g.Constant10_Value_ln; |
| 23734 | |
| 23735 | /* DataTypeConversion: '<S56>/Data Type Conversion' */ |
| 23736 | tmp = (real32_T)floor(rtu_Radar308_Info_st->leftRearRadar_Status.tStamp); |
| 23737 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23738 | tmp = 0.0F; |
| 23739 | } else { |
| 23740 | tmp = (real32_T)fmod(tmp, 256.0); |
| 23741 | } |
| 23742 | |
| 23743 | fusionAlg_B.BusCreator_o.radarState.msgAliveCounter = (uint8_T)(tmp < 0.0F ? |
| 23744 | (int32_T)(uint8_T)-(int8_T)(uint8_T)-tmp : (int32_T)(uint8_T)tmp); |
| 23745 | |
| 23746 | /* End of DataTypeConversion: '<S56>/Data Type Conversion' */ |
| 23747 | |
| 23748 | /* BusCreator: '<S56>/Bus Creator2' incorporates: |
| 23749 | * Constant: '<S56>/Constant' |
| 23750 | * Constant: '<S56>/Constant1' |
| 23751 | */ |
| 23752 | fusionAlg_B.BusCreator_o.radarState.reservedField.reserved1 = |
| 23753 | fusionAlg_P_g.Constant_Value_jv; |
| 23754 | fusionAlg_B.BusCreator_o.radarState.reservedField.reserved0 = |
| 23755 | fusionAlg_P_g.Constant1_Value_pe; |
| 23756 | |
| 23757 | /* BusCreator: '<S56>/Bus Creator1' incorporates: |
| 23758 | * Constant: '<S56>/Constant10' |
| 23759 | * Constant: '<S56>/Constant11' |
| 23760 | * Constant: '<S56>/Constant2' |
| 23761 | * Constant: '<S56>/Constant3' |
| 23762 | * Constant: '<S56>/Constant4' |
| 23763 | * Constant: '<S56>/Constant5' |
| 23764 | * Constant: '<S56>/Constant6' |
| 23765 | * Constant: '<S56>/Constant7' |
| 23766 | * Constant: '<S56>/Constant8' |
| 23767 | * Constant: '<S56>/Constant9' |
| 23768 | */ |
| 23769 | fusionAlg_B.BusCreator_o.radarState.hostYaw = |
| 23770 | fusionAlg_P_g.Constant2_Value_k5e; |
| 23771 | fusionAlg_B.BusCreator_o.radarState.hostSpeed = |
| 23772 | fusionAlg_P_g.Constant3_Value_ol; |
| 23773 | fusionAlg_B.BusCreator_o.radarState.timeStamp = |
| 23774 | fusionAlg_P_g.Constant4_Value_c0; |
| 23775 | fusionAlg_B.BusCreator_o.radarState.statusHWErr = |
| 23776 | fusionAlg_P_g.Constant5_Value_cku; |
| 23777 | fusionAlg_B.BusCreator_o.radarState.statusBlkProg = |
| 23778 | fusionAlg_P_g.Constant6_Value_pxl; |
| 23779 | fusionAlg_B.BusCreator_o.radarState.statusMisAlign = |
| 23780 | fusionAlg_P_g.Constant7_Value_gao; |
| 23781 | fusionAlg_B.BusCreator_o.radarState.sGUFail = fusionAlg_P_g.Constant8_Value_ex; |
| 23782 | fusionAlg_B.BusCreator_o.radarState.measEnabled = |
| 23783 | fusionAlg_P_g.Constant9_Value_fp; |
| 23784 | fusionAlg_B.BusCreator_o.radarState.latency = |
| 23785 | fusionAlg_P_g.Constant10_Value_ll; |
| 23786 | fusionAlg_B.BusCreator_o.radarState.msgCheckSum = |
| 23787 | fusionAlg_P_g.Constant11_Value_nd; |
| 23788 | |
| 23789 | /* BusCreator: '<S10>/Bus Creator1' incorporates: |
| 23790 | * Constant: '<S10>/Constant' |
| 23791 | * Constant: '<S10>/Constant1' |
| 23792 | */ |
| 23793 | fusionAlg_B.BusCreator_o.reserved.reserved0 = fusionAlg_P_g.Constant_Value_d5; |
| 23794 | fusionAlg_B.BusCreator_o.reserved.reserved1 = fusionAlg_P_g.Constant1_Value_i; |
| 23795 | |
| 23796 | /* BusCreator: '<S10>/Bus Creator' incorporates: |
| 23797 | * Constant: '<S10>/errType' |
| 23798 | * Constant: '<S10>/timestamp' |
| 23799 | */ |
| 23800 | fusionAlg_B.BusCreator_o.timestamp = fusionAlg_P_g.timestamp_Value_o; |
| 23801 | fusionAlg_B.BusCreator_o.errType = fusionAlg_P_g.errType_Value_ax; |
| 23802 | |
| 23803 | /* BusCreator: '<S5>/Bus Creator' */ |
| 23804 | fusionAlg_B.BusCreator.leftFrontRadar = fusionAlg_B.BusCreator_i; |
| 23805 | fusionAlg_B.BusCreator.rightFrontRadar = fusionAlg_B.BusCreator_a; |
| 23806 | fusionAlg_B.BusCreator.rightRearRadar = fusionAlg_B.BusCreator_ad; |
| 23807 | fusionAlg_B.BusCreator.leftRearRadar = fusionAlg_B.BusCreator_o; |
| 23808 | |
| 23809 | /* BusCreator: '<S6>/Bus Creator' incorporates: |
| 23810 | * Constant: '<S6>/motionStatus' |
| 23811 | */ |
| 23812 | fusionAlg_B.BusCreator_fo.yawRate = *rtu_VSI_VehState_st_YrsF; |
| 23813 | fusionAlg_B.BusCreator_fo.motionStatus = fusionAlg_P_g.motionStatus_Value; |
| 23814 | fusionAlg_B.BusCreator_fo.speed = *rtu_VSI_VehState_st_vRef; |
| 23815 | fusionAlg_B.BusCreator_fo.acceleration = *rtu_VSI_VehState_st_aRef; |
| 23816 | |
| 23817 | /* DataTypeConversion: '<S231>/Data Type Conversion' */ |
| 23818 | tmp = (real32_T)floor |
| 23819 | (rtu_EyeQ4_Info_st->LANE_DATA_ST.Host_Prot_Header.LH_Sync_ID); |
| 23820 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23821 | tmp = 0.0F; |
| 23822 | } else { |
| 23823 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23824 | } |
| 23825 | |
| 23826 | fusionAlg_B.BusCreator1_ky.lhsyncid = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 23827 | (uint32_T)-tmp : (uint32_T)tmp; |
| 23828 | |
| 23829 | /* End of DataTypeConversion: '<S231>/Data Type Conversion' */ |
| 23830 | |
| 23831 | /* DataTypeConversion: '<S231>/Data Type Conversion1' */ |
| 23832 | tmp = (real32_T)floor |
| 23833 | (rtu_EyeQ4_Info_st->LANE_DATA_ST.Host_Prot_Header.LH_Lanes_Count); |
| 23834 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23835 | tmp = 0.0F; |
| 23836 | } else { |
| 23837 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23838 | } |
| 23839 | |
| 23840 | fusionAlg_B.BusCreator1_ky.lhlanecount = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 23841 | (uint32_T)-tmp : (uint32_T)tmp; |
| 23842 | |
| 23843 | /* End of DataTypeConversion: '<S231>/Data Type Conversion1' */ |
| 23844 | |
| 23845 | /* BusCreator: '<S231>/Bus Creator1' */ |
| 23846 | fusionAlg_B.BusCreator1_ky.lhestimatedwidth = |
| 23847 | rtu_EyeQ4_Info_st->LANE_DATA_ST.Host_Prot_Header.LH_Estimated_Width; |
| 23848 | fusionAlg_B.BusCreator1_ky.lhsnowonroadprob = |
| 23849 | rtu_EyeQ4_Info_st->LANE_DATA_ST.Host_Prot_Header.LH_Sonw_On_Road_Prob; |
| 23850 | |
| 23851 | /* Selector: '<S222>/Selector' incorporates: |
| 23852 | * Constant: '<S222>/Constant' |
| 23853 | */ |
| 23854 | fusionAlg_B.Selector_a = rtu_EyeQ4_Info_st-> |
| 23855 | LANE_DATA_ST.Host_Prot[fusionAlg_P_g.Constant_Value_ouc]; |
| 23856 | |
| 23857 | /* DataTypeConversion: '<S229>/Data Type Conversion' */ |
| 23858 | tmp = (real32_T)floor(fusionAlg_B.Selector_a.LH_side); |
| 23859 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23860 | tmp = 0.0F; |
| 23861 | } else { |
| 23862 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23863 | } |
| 23864 | |
| 23865 | fusionAlg_B.BusCreator1_d.lhside = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 23866 | -tmp : (uint32_T)tmp; |
| 23867 | |
| 23868 | /* End of DataTypeConversion: '<S229>/Data Type Conversion' */ |
| 23869 | |
| 23870 | /* DataTypeConversion: '<S229>/Data Type Conversion1' */ |
| 23871 | tmp = (real32_T)floor(fusionAlg_B.Selector_a.LH_Track_ID); |
| 23872 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23873 | tmp = 0.0F; |
| 23874 | } else { |
| 23875 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23876 | } |
| 23877 | |
| 23878 | fusionAlg_B.BusCreator1_d.lhtrackid = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 23879 | (uint32_T)-tmp : (uint32_T)tmp; |
| 23880 | |
| 23881 | /* End of DataTypeConversion: '<S229>/Data Type Conversion1' */ |
| 23882 | |
| 23883 | /* DataTypeConversion: '<S229>/Data Type Conversion2' */ |
| 23884 | tmp = (real32_T)floor(fusionAlg_B.Selector_a.LH_Color); |
| 23885 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23886 | tmp = 0.0F; |
| 23887 | } else { |
| 23888 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23889 | } |
| 23890 | |
| 23891 | fusionAlg_B.BusCreator1_d.lhcolor = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 23892 | -tmp : (uint32_T)tmp; |
| 23893 | |
| 23894 | /* End of DataTypeConversion: '<S229>/Data Type Conversion2' */ |
| 23895 | |
| 23896 | /* DataTypeConversion: '<S229>/Data Type Conversion3' */ |
| 23897 | tmp = (real32_T)floor(fusionAlg_B.Selector_a.LH_Lanemark_Type); |
| 23898 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23899 | tmp = 0.0F; |
| 23900 | } else { |
| 23901 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23902 | } |
| 23903 | |
| 23904 | fusionAlg_B.LH_Lanemark_Type = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp |
| 23905 | : (uint32_T)tmp; |
| 23906 | |
| 23907 | /* End of DataTypeConversion: '<S229>/Data Type Conversion3' */ |
| 23908 | |
| 23909 | /* DataTypeConversion: '<S229>/Data Type Conversion4' */ |
| 23910 | tmp = (real32_T)floor(fusionAlg_B.Selector_a.LH_Lanemark_Type_Conf); |
| 23911 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23912 | tmp = 0.0F; |
| 23913 | } else { |
| 23914 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23915 | } |
| 23916 | |
| 23917 | fusionAlg_B.LH_Lanemark_Type_Conf = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 23918 | -tmp : (uint32_T)tmp; |
| 23919 | |
| 23920 | /* End of DataTypeConversion: '<S229>/Data Type Conversion4' */ |
| 23921 | |
| 23922 | /* DataTypeConversion: '<S229>/Data Type Conversion5' */ |
| 23923 | tmp = (real32_T)floor(fusionAlg_B.Selector_a.LH_DLM_Type); |
| 23924 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23925 | tmp = 0.0F; |
| 23926 | } else { |
| 23927 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23928 | } |
| 23929 | |
| 23930 | fusionAlg_B.BusCreator1_d.lhdlmtype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 23931 | (uint32_T)-tmp : (uint32_T)tmp; |
| 23932 | |
| 23933 | /* End of DataTypeConversion: '<S229>/Data Type Conversion5' */ |
| 23934 | |
| 23935 | /* BusCreator: '<S229>/Bus Creator1' */ |
| 23936 | fusionAlg_B.BusCreator1_d.lhlinefirstC0 = |
| 23937 | fusionAlg_B.Selector_a.LH_Line_First_C0; |
| 23938 | fusionAlg_B.BusCreator1_d.lhlinefirstC1 = |
| 23939 | fusionAlg_B.Selector_a.LH_Line_First_C1; |
| 23940 | fusionAlg_B.BusCreator1_d.lhlinefirstC2 = |
| 23941 | fusionAlg_B.Selector_a.LH_Line_First_C2; |
| 23942 | fusionAlg_B.BusCreator1_d.lhlinefirstC3 = |
| 23943 | fusionAlg_B.Selector_a.LH_Line_First_C3; |
| 23944 | fusionAlg_B.BusCreator1_d.lhfirstvrStart = |
| 23945 | fusionAlg_B.Selector_a.LH_First_VR_Start; |
| 23946 | fusionAlg_B.BusCreator1_d.lhfirstvrEnd = |
| 23947 | fusionAlg_B.Selector_a.LH_First_VR_End; |
| 23948 | fusionAlg_B.BusCreator1_d.lhmarkerwidth = |
| 23949 | fusionAlg_B.Selector_a.LH_Marker_Width; |
| 23950 | fusionAlg_B.BusCreator1_d.lhmarkerwidthSTD = |
| 23951 | fusionAlg_B.Selector_a.LH_Marker_Width_STD; |
| 23952 | fusionAlg_B.BusCreator1_d.lhexistenceprobability = |
| 23953 | fusionAlg_B.Selector_a.LH_Existence_Probability; |
| 23954 | fusionAlg_B.BusCreator1_d.lhlanemarktype = fusionAlg_B.LH_Lanemark_Type; |
| 23955 | fusionAlg_B.BusCreator1_d.lhlanemarktypeconf = |
| 23956 | fusionAlg_B.LH_Lanemark_Type_Conf; |
| 23957 | |
| 23958 | /* Selector: '<S222>/Selector1' incorporates: |
| 23959 | * Constant: '<S222>/Constant1' |
| 23960 | */ |
| 23961 | fusionAlg_B.Selector1_k = rtu_EyeQ4_Info_st-> |
| 23962 | LANE_DATA_ST.Host_Prot[fusionAlg_P_g.Constant1_Value_ber]; |
| 23963 | |
| 23964 | /* DataTypeConversion: '<S230>/Data Type Conversion' */ |
| 23965 | tmp = (real32_T)floor(fusionAlg_B.Selector1_k.LH_side); |
| 23966 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23967 | tmp = 0.0F; |
| 23968 | } else { |
| 23969 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23970 | } |
| 23971 | |
| 23972 | fusionAlg_B.BusCreator1_lt.lhside = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 23973 | -tmp : (uint32_T)tmp; |
| 23974 | |
| 23975 | /* End of DataTypeConversion: '<S230>/Data Type Conversion' */ |
| 23976 | |
| 23977 | /* DataTypeConversion: '<S230>/Data Type Conversion1' */ |
| 23978 | tmp = (real32_T)floor(fusionAlg_B.Selector1_k.LH_Track_ID); |
| 23979 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23980 | tmp = 0.0F; |
| 23981 | } else { |
| 23982 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23983 | } |
| 23984 | |
| 23985 | fusionAlg_B.BusCreator1_lt.lhtrackid = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 23986 | (uint32_T)-tmp : (uint32_T)tmp; |
| 23987 | |
| 23988 | /* End of DataTypeConversion: '<S230>/Data Type Conversion1' */ |
| 23989 | |
| 23990 | /* DataTypeConversion: '<S230>/Data Type Conversion2' */ |
| 23991 | tmp = (real32_T)floor(fusionAlg_B.Selector1_k.LH_Color); |
| 23992 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 23993 | tmp = 0.0F; |
| 23994 | } else { |
| 23995 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 23996 | } |
| 23997 | |
| 23998 | fusionAlg_B.BusCreator1_lt.lhcolor = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 23999 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24000 | |
| 24001 | /* End of DataTypeConversion: '<S230>/Data Type Conversion2' */ |
| 24002 | |
| 24003 | /* DataTypeConversion: '<S230>/Data Type Conversion3' */ |
| 24004 | tmp = (real32_T)floor(fusionAlg_B.Selector1_k.LH_Lanemark_Type); |
| 24005 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24006 | tmp = 0.0F; |
| 24007 | } else { |
| 24008 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24009 | } |
| 24010 | |
| 24011 | fusionAlg_B.LH_Lanemark_Type_g = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 24012 | -tmp : (uint32_T)tmp; |
| 24013 | |
| 24014 | /* End of DataTypeConversion: '<S230>/Data Type Conversion3' */ |
| 24015 | |
| 24016 | /* DataTypeConversion: '<S230>/Data Type Conversion4' */ |
| 24017 | tmp = (real32_T)floor(fusionAlg_B.Selector1_k.LH_Lanemark_Type_Conf); |
| 24018 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24019 | tmp = 0.0F; |
| 24020 | } else { |
| 24021 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24022 | } |
| 24023 | |
| 24024 | fusionAlg_B.LH_Lanemark_Type_Conf_b = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24025 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24026 | |
| 24027 | /* End of DataTypeConversion: '<S230>/Data Type Conversion4' */ |
| 24028 | |
| 24029 | /* DataTypeConversion: '<S230>/Data Type Conversion5' */ |
| 24030 | tmp = (real32_T)floor(fusionAlg_B.Selector1_k.LH_DLM_Type); |
| 24031 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24032 | tmp = 0.0F; |
| 24033 | } else { |
| 24034 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24035 | } |
| 24036 | |
| 24037 | fusionAlg_B.BusCreator1_lt.lhdlmtype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24038 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24039 | |
| 24040 | /* End of DataTypeConversion: '<S230>/Data Type Conversion5' */ |
| 24041 | |
| 24042 | /* BusCreator: '<S230>/Bus Creator1' */ |
| 24043 | fusionAlg_B.BusCreator1_lt.lhlinefirstC0 = |
| 24044 | fusionAlg_B.Selector1_k.LH_Line_First_C0; |
| 24045 | fusionAlg_B.BusCreator1_lt.lhlinefirstC1 = |
| 24046 | fusionAlg_B.Selector1_k.LH_Line_First_C1; |
| 24047 | fusionAlg_B.BusCreator1_lt.lhlinefirstC2 = |
| 24048 | fusionAlg_B.Selector1_k.LH_Line_First_C2; |
| 24049 | fusionAlg_B.BusCreator1_lt.lhlinefirstC3 = |
| 24050 | fusionAlg_B.Selector1_k.LH_Line_First_C3; |
| 24051 | fusionAlg_B.BusCreator1_lt.lhfirstvrStart = |
| 24052 | fusionAlg_B.Selector1_k.LH_First_VR_Start; |
| 24053 | fusionAlg_B.BusCreator1_lt.lhfirstvrEnd = |
| 24054 | fusionAlg_B.Selector1_k.LH_First_VR_End; |
| 24055 | fusionAlg_B.BusCreator1_lt.lhmarkerwidth = |
| 24056 | fusionAlg_B.Selector1_k.LH_Marker_Width; |
| 24057 | fusionAlg_B.BusCreator1_lt.lhmarkerwidthSTD = |
| 24058 | fusionAlg_B.Selector1_k.LH_Marker_Width_STD; |
| 24059 | fusionAlg_B.BusCreator1_lt.lhexistenceprobability = |
| 24060 | fusionAlg_B.Selector1_k.LH_Existence_Probability; |
| 24061 | fusionAlg_B.BusCreator1_lt.lhlanemarktype = fusionAlg_B.LH_Lanemark_Type_g; |
| 24062 | fusionAlg_B.BusCreator1_lt.lhlanemarktypeconf = |
| 24063 | fusionAlg_B.LH_Lanemark_Type_Conf_b; |
| 24064 | |
| 24065 | /* Selector: '<S222>/Selector2' incorporates: |
| 24066 | * Constant: '<S222>/Constant2' |
| 24067 | */ |
| 24068 | fusionAlg_B.Selector2_c = rtu_EyeQ4_Info_st-> |
| 24069 | LANE_DATA_ST.Adja_Prot[fusionAlg_P_g.Constant2_Value_iai]; |
| 24070 | |
| 24071 | /* DataTypeConversion: '<S225>/Data Type Conversion' */ |
| 24072 | tmp = (real32_T)floor(fusionAlg_B.Selector2_c.LA_Line_Role); |
| 24073 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24074 | tmp = 0.0F; |
| 24075 | } else { |
| 24076 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24077 | } |
| 24078 | |
| 24079 | fusionAlg_B.BusCreator1_i.linerole = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24080 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24081 | |
| 24082 | /* End of DataTypeConversion: '<S225>/Data Type Conversion' */ |
| 24083 | |
| 24084 | /* DataTypeConversion: '<S225>/Data Type Conversion1' */ |
| 24085 | tmp = (real32_T)floor(fusionAlg_B.Selector2_c.LA_Lane_Track_ID); |
| 24086 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24087 | tmp = 0.0F; |
| 24088 | } else { |
| 24089 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24090 | } |
| 24091 | |
| 24092 | fusionAlg_B.BusCreator1_i.lanetrackid = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24093 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24094 | |
| 24095 | /* End of DataTypeConversion: '<S225>/Data Type Conversion1' */ |
| 24096 | |
| 24097 | /* DataTypeConversion: '<S225>/Data Type Conversion2' */ |
| 24098 | tmp = (real32_T)floor(fusionAlg_B.Selector2_c.LA_Age); |
| 24099 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24100 | tmp = 0.0F; |
| 24101 | } else { |
| 24102 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24103 | } |
| 24104 | |
| 24105 | fusionAlg_B.BusCreator1_i.age = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 24106 | -tmp : (uint32_T)tmp; |
| 24107 | |
| 24108 | /* End of DataTypeConversion: '<S225>/Data Type Conversion2' */ |
| 24109 | |
| 24110 | /* DataTypeConversion: '<S225>/Data Type Conversion3' */ |
| 24111 | tmp = (real32_T)floor(fusionAlg_B.Selector2_c.LA_Color); |
| 24112 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24113 | tmp = 0.0F; |
| 24114 | } else { |
| 24115 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24116 | } |
| 24117 | |
| 24118 | fusionAlg_B.LA_Color = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24119 | (uint32_T)tmp; |
| 24120 | |
| 24121 | /* End of DataTypeConversion: '<S225>/Data Type Conversion3' */ |
| 24122 | |
| 24123 | /* DataTypeConversion: '<S225>/Data Type Conversion4' */ |
| 24124 | tmp = (real32_T)floor(fusionAlg_B.Selector2_c.LA_Color_Conf); |
| 24125 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24126 | tmp = 0.0F; |
| 24127 | } else { |
| 24128 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24129 | } |
| 24130 | |
| 24131 | fusionAlg_B.LA_Color_Conf = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24132 | (uint32_T)tmp; |
| 24133 | |
| 24134 | /* End of DataTypeConversion: '<S225>/Data Type Conversion4' */ |
| 24135 | |
| 24136 | /* DataTypeConversion: '<S225>/Data Type Conversion5' */ |
| 24137 | tmp = (real32_T)floor(fusionAlg_B.Selector2_c.LA_Lanemark_Type); |
| 24138 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24139 | tmp = 0.0F; |
| 24140 | } else { |
| 24141 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24142 | } |
| 24143 | |
| 24144 | fusionAlg_B.LA_LaneMark_Type = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp |
| 24145 | : (uint32_T)tmp; |
| 24146 | |
| 24147 | /* End of DataTypeConversion: '<S225>/Data Type Conversion5' */ |
| 24148 | |
| 24149 | /* DataTypeConversion: '<S225>/Data Type Conversion6' */ |
| 24150 | tmp = (real32_T)floor(fusionAlg_B.Selector2_c.LA_Lanemark_Type_Conf); |
| 24151 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24152 | tmp = 0.0F; |
| 24153 | } else { |
| 24154 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24155 | } |
| 24156 | |
| 24157 | fusionAlg_B.LA_LaneMark_Type_Conf = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 24158 | -tmp : (uint32_T)tmp; |
| 24159 | |
| 24160 | /* End of DataTypeConversion: '<S225>/Data Type Conversion6' */ |
| 24161 | |
| 24162 | /* DataTypeConversion: '<S225>/Data Type Conversion7' */ |
| 24163 | tmp = (real32_T)floor(fusionAlg_B.Selector2_c.LA_DLM_Type); |
| 24164 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24165 | tmp = 0.0F; |
| 24166 | } else { |
| 24167 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24168 | } |
| 24169 | |
| 24170 | fusionAlg_B.BusCreator1_i.ladlmtype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24171 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24172 | |
| 24173 | /* End of DataTypeConversion: '<S225>/Data Type Conversion7' */ |
| 24174 | |
| 24175 | /* BusCreator: '<S225>/Bus Creator1' */ |
| 24176 | fusionAlg_B.BusCreator1_i.lhlinefirstC0 = fusionAlg_B.Selector2_c.LA_Line_C0; |
| 24177 | fusionAlg_B.BusCreator1_i.lhlinefirstC1 = fusionAlg_B.Selector2_c.LA_Line_C1; |
| 24178 | fusionAlg_B.BusCreator1_i.lhlinefirstC2 = fusionAlg_B.Selector2_c.LA_Line_C2; |
| 24179 | fusionAlg_B.BusCreator1_i.lhlinefirstC3 = fusionAlg_B.Selector2_c.LA_Line_C3; |
| 24180 | fusionAlg_B.BusCreator1_i.color = fusionAlg_B.LA_Color; |
| 24181 | fusionAlg_B.BusCreator1_i.colorconf = fusionAlg_B.LA_Color_Conf; |
| 24182 | fusionAlg_B.BusCreator1_i.lanemarkerwidth = |
| 24183 | fusionAlg_B.Selector2_c.LA_Marker_Width; |
| 24184 | fusionAlg_B.BusCreator1_i.lanemarkerwidthSTD = |
| 24185 | fusionAlg_B.Selector2_c.LA_Marker_Width_STD; |
| 24186 | fusionAlg_B.BusCreator1_i.lavrstart = |
| 24187 | fusionAlg_B.Selector2_c.LA_View_Range_Start; |
| 24188 | fusionAlg_B.BusCreator1_i.lavrend = fusionAlg_B.Selector2_c.LA_View_Range_End; |
| 24189 | fusionAlg_B.BusCreator1_i.laexistprobalility = |
| 24190 | fusionAlg_B.Selector2_c.LA_Exist_Probability; |
| 24191 | fusionAlg_B.BusCreator1_i.lalanemarktype = fusionAlg_B.LA_LaneMark_Type; |
| 24192 | fusionAlg_B.BusCreator1_i.lalanemarktypeconf = |
| 24193 | fusionAlg_B.LA_LaneMark_Type_Conf; |
| 24194 | |
| 24195 | /* Selector: '<S222>/Selector3' incorporates: |
| 24196 | * Constant: '<S222>/Constant3' |
| 24197 | */ |
| 24198 | fusionAlg_B.Selector3_j = rtu_EyeQ4_Info_st-> |
| 24199 | LANE_DATA_ST.Adja_Prot[fusionAlg_P_g.Constant3_Value_dlg]; |
| 24200 | |
| 24201 | /* DataTypeConversion: '<S226>/Data Type Conversion' */ |
| 24202 | tmp = (real32_T)floor(fusionAlg_B.Selector3_j.LA_Line_Role); |
| 24203 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24204 | tmp = 0.0F; |
| 24205 | } else { |
| 24206 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24207 | } |
| 24208 | |
| 24209 | fusionAlg_B.BusCreator1_h.linerole = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24210 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24211 | |
| 24212 | /* End of DataTypeConversion: '<S226>/Data Type Conversion' */ |
| 24213 | |
| 24214 | /* DataTypeConversion: '<S226>/Data Type Conversion1' */ |
| 24215 | tmp = (real32_T)floor(fusionAlg_B.Selector3_j.LA_Lane_Track_ID); |
| 24216 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24217 | tmp = 0.0F; |
| 24218 | } else { |
| 24219 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24220 | } |
| 24221 | |
| 24222 | fusionAlg_B.BusCreator1_h.lanetrackid = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24223 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24224 | |
| 24225 | /* End of DataTypeConversion: '<S226>/Data Type Conversion1' */ |
| 24226 | |
| 24227 | /* DataTypeConversion: '<S226>/Data Type Conversion2' */ |
| 24228 | tmp = (real32_T)floor(fusionAlg_B.Selector3_j.LA_Age); |
| 24229 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24230 | tmp = 0.0F; |
| 24231 | } else { |
| 24232 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24233 | } |
| 24234 | |
| 24235 | fusionAlg_B.BusCreator1_h.age = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 24236 | -tmp : (uint32_T)tmp; |
| 24237 | |
| 24238 | /* End of DataTypeConversion: '<S226>/Data Type Conversion2' */ |
| 24239 | |
| 24240 | /* DataTypeConversion: '<S226>/Data Type Conversion3' */ |
| 24241 | tmp = (real32_T)floor(fusionAlg_B.Selector3_j.LA_Color); |
| 24242 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24243 | tmp = 0.0F; |
| 24244 | } else { |
| 24245 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24246 | } |
| 24247 | |
| 24248 | fusionAlg_B.LA_Color_k = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24249 | (uint32_T)tmp; |
| 24250 | |
| 24251 | /* End of DataTypeConversion: '<S226>/Data Type Conversion3' */ |
| 24252 | |
| 24253 | /* DataTypeConversion: '<S226>/Data Type Conversion4' */ |
| 24254 | tmp = (real32_T)floor(fusionAlg_B.Selector3_j.LA_Color_Conf); |
| 24255 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24256 | tmp = 0.0F; |
| 24257 | } else { |
| 24258 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24259 | } |
| 24260 | |
| 24261 | fusionAlg_B.LA_Color_Conf_m = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24262 | (uint32_T)tmp; |
| 24263 | |
| 24264 | /* End of DataTypeConversion: '<S226>/Data Type Conversion4' */ |
| 24265 | |
| 24266 | /* DataTypeConversion: '<S226>/Data Type Conversion5' */ |
| 24267 | tmp = (real32_T)floor(fusionAlg_B.Selector3_j.LA_Lanemark_Type); |
| 24268 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24269 | tmp = 0.0F; |
| 24270 | } else { |
| 24271 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24272 | } |
| 24273 | |
| 24274 | fusionAlg_B.LA_LaneMark_Type_g = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 24275 | -tmp : (uint32_T)tmp; |
| 24276 | |
| 24277 | /* End of DataTypeConversion: '<S226>/Data Type Conversion5' */ |
| 24278 | |
| 24279 | /* DataTypeConversion: '<S226>/Data Type Conversion6' */ |
| 24280 | tmp = (real32_T)floor(fusionAlg_B.Selector3_j.LA_Lanemark_Type_Conf); |
| 24281 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24282 | tmp = 0.0F; |
| 24283 | } else { |
| 24284 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24285 | } |
| 24286 | |
| 24287 | fusionAlg_B.LA_LaneMark_Type_Conf_i = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24288 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24289 | |
| 24290 | /* End of DataTypeConversion: '<S226>/Data Type Conversion6' */ |
| 24291 | |
| 24292 | /* DataTypeConversion: '<S226>/Data Type Conversion7' */ |
| 24293 | tmp = (real32_T)floor(fusionAlg_B.Selector3_j.LA_DLM_Type); |
| 24294 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24295 | tmp = 0.0F; |
| 24296 | } else { |
| 24297 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24298 | } |
| 24299 | |
| 24300 | fusionAlg_B.BusCreator1_h.ladlmtype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24301 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24302 | |
| 24303 | /* End of DataTypeConversion: '<S226>/Data Type Conversion7' */ |
| 24304 | |
| 24305 | /* BusCreator: '<S226>/Bus Creator1' */ |
| 24306 | fusionAlg_B.BusCreator1_h.lhlinefirstC0 = fusionAlg_B.Selector3_j.LA_Line_C0; |
| 24307 | fusionAlg_B.BusCreator1_h.lhlinefirstC1 = fusionAlg_B.Selector3_j.LA_Line_C1; |
| 24308 | fusionAlg_B.BusCreator1_h.lhlinefirstC2 = fusionAlg_B.Selector3_j.LA_Line_C2; |
| 24309 | fusionAlg_B.BusCreator1_h.lhlinefirstC3 = fusionAlg_B.Selector3_j.LA_Line_C3; |
| 24310 | fusionAlg_B.BusCreator1_h.color = fusionAlg_B.LA_Color_k; |
| 24311 | fusionAlg_B.BusCreator1_h.colorconf = fusionAlg_B.LA_Color_Conf_m; |
| 24312 | fusionAlg_B.BusCreator1_h.lanemarkerwidth = |
| 24313 | fusionAlg_B.Selector3_j.LA_Marker_Width; |
| 24314 | fusionAlg_B.BusCreator1_h.lanemarkerwidthSTD = |
| 24315 | fusionAlg_B.Selector3_j.LA_Marker_Width_STD; |
| 24316 | fusionAlg_B.BusCreator1_h.lavrstart = |
| 24317 | fusionAlg_B.Selector3_j.LA_View_Range_Start; |
| 24318 | fusionAlg_B.BusCreator1_h.lavrend = fusionAlg_B.Selector3_j.LA_View_Range_End; |
| 24319 | fusionAlg_B.BusCreator1_h.laexistprobalility = |
| 24320 | fusionAlg_B.Selector3_j.LA_Exist_Probability; |
| 24321 | fusionAlg_B.BusCreator1_h.lalanemarktype = fusionAlg_B.LA_LaneMark_Type_g; |
| 24322 | fusionAlg_B.BusCreator1_h.lalanemarktypeconf = |
| 24323 | fusionAlg_B.LA_LaneMark_Type_Conf_i; |
| 24324 | |
| 24325 | /* Selector: '<S222>/Selector4' incorporates: |
| 24326 | * Constant: '<S222>/Constant4' |
| 24327 | */ |
| 24328 | fusionAlg_B.Selector4_d = rtu_EyeQ4_Info_st-> |
| 24329 | LANE_DATA_ST.Adja_Prot[fusionAlg_P_g.Constant4_Value_i0]; |
| 24330 | |
| 24331 | /* DataTypeConversion: '<S227>/Data Type Conversion' */ |
| 24332 | tmp = (real32_T)floor(fusionAlg_B.Selector4_d.LA_Line_Role); |
| 24333 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24334 | tmp = 0.0F; |
| 24335 | } else { |
| 24336 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24337 | } |
| 24338 | |
| 24339 | fusionAlg_B.BusCreator1_l.linerole = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24340 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24341 | |
| 24342 | /* End of DataTypeConversion: '<S227>/Data Type Conversion' */ |
| 24343 | |
| 24344 | /* DataTypeConversion: '<S227>/Data Type Conversion1' */ |
| 24345 | tmp = (real32_T)floor(fusionAlg_B.Selector4_d.LA_Lane_Track_ID); |
| 24346 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24347 | tmp = 0.0F; |
| 24348 | } else { |
| 24349 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24350 | } |
| 24351 | |
| 24352 | fusionAlg_B.BusCreator1_l.lanetrackid = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24353 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24354 | |
| 24355 | /* End of DataTypeConversion: '<S227>/Data Type Conversion1' */ |
| 24356 | |
| 24357 | /* DataTypeConversion: '<S227>/Data Type Conversion2' */ |
| 24358 | tmp = (real32_T)floor(fusionAlg_B.Selector4_d.LA_Age); |
| 24359 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24360 | tmp = 0.0F; |
| 24361 | } else { |
| 24362 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24363 | } |
| 24364 | |
| 24365 | fusionAlg_B.BusCreator1_l.age = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 24366 | -tmp : (uint32_T)tmp; |
| 24367 | |
| 24368 | /* End of DataTypeConversion: '<S227>/Data Type Conversion2' */ |
| 24369 | |
| 24370 | /* DataTypeConversion: '<S227>/Data Type Conversion3' */ |
| 24371 | tmp = (real32_T)floor(fusionAlg_B.Selector4_d.LA_Color); |
| 24372 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24373 | tmp = 0.0F; |
| 24374 | } else { |
| 24375 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24376 | } |
| 24377 | |
| 24378 | fusionAlg_B.LA_Color_m = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24379 | (uint32_T)tmp; |
| 24380 | |
| 24381 | /* End of DataTypeConversion: '<S227>/Data Type Conversion3' */ |
| 24382 | |
| 24383 | /* DataTypeConversion: '<S227>/Data Type Conversion4' */ |
| 24384 | tmp = (real32_T)floor(fusionAlg_B.Selector4_d.LA_Color_Conf); |
| 24385 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24386 | tmp = 0.0F; |
| 24387 | } else { |
| 24388 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24389 | } |
| 24390 | |
| 24391 | fusionAlg_B.LA_Color_Conf_h = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24392 | (uint32_T)tmp; |
| 24393 | |
| 24394 | /* End of DataTypeConversion: '<S227>/Data Type Conversion4' */ |
| 24395 | |
| 24396 | /* DataTypeConversion: '<S227>/Data Type Conversion5' */ |
| 24397 | tmp = (real32_T)floor(fusionAlg_B.Selector4_d.LA_Lanemark_Type); |
| 24398 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24399 | tmp = 0.0F; |
| 24400 | } else { |
| 24401 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24402 | } |
| 24403 | |
| 24404 | fusionAlg_B.LA_LaneMark_Type_n = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 24405 | -tmp : (uint32_T)tmp; |
| 24406 | |
| 24407 | /* End of DataTypeConversion: '<S227>/Data Type Conversion5' */ |
| 24408 | |
| 24409 | /* DataTypeConversion: '<S227>/Data Type Conversion6' */ |
| 24410 | tmp = (real32_T)floor(fusionAlg_B.Selector4_d.LA_Lanemark_Type_Conf); |
| 24411 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24412 | tmp = 0.0F; |
| 24413 | } else { |
| 24414 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24415 | } |
| 24416 | |
| 24417 | fusionAlg_B.LA_LaneMark_Type_Conf_d = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24418 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24419 | |
| 24420 | /* End of DataTypeConversion: '<S227>/Data Type Conversion6' */ |
| 24421 | |
| 24422 | /* DataTypeConversion: '<S227>/Data Type Conversion7' */ |
| 24423 | tmp = (real32_T)floor(fusionAlg_B.Selector4_d.LA_DLM_Type); |
| 24424 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24425 | tmp = 0.0F; |
| 24426 | } else { |
| 24427 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24428 | } |
| 24429 | |
| 24430 | fusionAlg_B.BusCreator1_l.ladlmtype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24431 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24432 | |
| 24433 | /* End of DataTypeConversion: '<S227>/Data Type Conversion7' */ |
| 24434 | |
| 24435 | /* BusCreator: '<S227>/Bus Creator1' */ |
| 24436 | fusionAlg_B.BusCreator1_l.lhlinefirstC0 = fusionAlg_B.Selector4_d.LA_Line_C0; |
| 24437 | fusionAlg_B.BusCreator1_l.lhlinefirstC1 = fusionAlg_B.Selector4_d.LA_Line_C1; |
| 24438 | fusionAlg_B.BusCreator1_l.lhlinefirstC2 = fusionAlg_B.Selector4_d.LA_Line_C2; |
| 24439 | fusionAlg_B.BusCreator1_l.lhlinefirstC3 = fusionAlg_B.Selector4_d.LA_Line_C3; |
| 24440 | fusionAlg_B.BusCreator1_l.color = fusionAlg_B.LA_Color_m; |
| 24441 | fusionAlg_B.BusCreator1_l.colorconf = fusionAlg_B.LA_Color_Conf_h; |
| 24442 | fusionAlg_B.BusCreator1_l.lanemarkerwidth = |
| 24443 | fusionAlg_B.Selector4_d.LA_Marker_Width; |
| 24444 | fusionAlg_B.BusCreator1_l.lanemarkerwidthSTD = |
| 24445 | fusionAlg_B.Selector4_d.LA_Marker_Width_STD; |
| 24446 | fusionAlg_B.BusCreator1_l.lavrstart = |
| 24447 | fusionAlg_B.Selector4_d.LA_View_Range_Start; |
| 24448 | fusionAlg_B.BusCreator1_l.lavrend = fusionAlg_B.Selector4_d.LA_View_Range_End; |
| 24449 | fusionAlg_B.BusCreator1_l.laexistprobalility = |
| 24450 | fusionAlg_B.Selector4_d.LA_Exist_Probability; |
| 24451 | fusionAlg_B.BusCreator1_l.lalanemarktype = fusionAlg_B.LA_LaneMark_Type_n; |
| 24452 | fusionAlg_B.BusCreator1_l.lalanemarktypeconf = |
| 24453 | fusionAlg_B.LA_LaneMark_Type_Conf_d; |
| 24454 | |
| 24455 | /* Selector: '<S222>/Selector5' incorporates: |
| 24456 | * Constant: '<S222>/Constant5' |
| 24457 | */ |
| 24458 | fusionAlg_B.Selector5_f = rtu_EyeQ4_Info_st-> |
| 24459 | LANE_DATA_ST.Adja_Prot[fusionAlg_P_g.Constant5_Value_iv]; |
| 24460 | |
| 24461 | /* DataTypeConversion: '<S228>/Data Type Conversion' */ |
| 24462 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f.LA_Line_Role); |
| 24463 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24464 | tmp = 0.0F; |
| 24465 | } else { |
| 24466 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24467 | } |
| 24468 | |
| 24469 | fusionAlg_B.BusCreator1_lc.linerole = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24470 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24471 | |
| 24472 | /* End of DataTypeConversion: '<S228>/Data Type Conversion' */ |
| 24473 | |
| 24474 | /* DataTypeConversion: '<S228>/Data Type Conversion1' */ |
| 24475 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f.LA_Lane_Track_ID); |
| 24476 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24477 | tmp = 0.0F; |
| 24478 | } else { |
| 24479 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24480 | } |
| 24481 | |
| 24482 | fusionAlg_B.BusCreator1_lc.lanetrackid = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24483 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24484 | |
| 24485 | /* End of DataTypeConversion: '<S228>/Data Type Conversion1' */ |
| 24486 | |
| 24487 | /* DataTypeConversion: '<S228>/Data Type Conversion2' */ |
| 24488 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f.LA_Age); |
| 24489 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24490 | tmp = 0.0F; |
| 24491 | } else { |
| 24492 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24493 | } |
| 24494 | |
| 24495 | fusionAlg_B.BusCreator1_lc.age = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 24496 | -tmp : (uint32_T)tmp; |
| 24497 | |
| 24498 | /* End of DataTypeConversion: '<S228>/Data Type Conversion2' */ |
| 24499 | |
| 24500 | /* DataTypeConversion: '<S228>/Data Type Conversion3' */ |
| 24501 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f.LA_Color); |
| 24502 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24503 | tmp = 0.0F; |
| 24504 | } else { |
| 24505 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24506 | } |
| 24507 | |
| 24508 | fusionAlg_B.LA_Color_l = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24509 | (uint32_T)tmp; |
| 24510 | |
| 24511 | /* End of DataTypeConversion: '<S228>/Data Type Conversion3' */ |
| 24512 | |
| 24513 | /* DataTypeConversion: '<S228>/Data Type Conversion4' */ |
| 24514 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f.LA_Color_Conf); |
| 24515 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24516 | tmp = 0.0F; |
| 24517 | } else { |
| 24518 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24519 | } |
| 24520 | |
| 24521 | fusionAlg_B.LA_Color_Conf_hj = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp |
| 24522 | : (uint32_T)tmp; |
| 24523 | |
| 24524 | /* End of DataTypeConversion: '<S228>/Data Type Conversion4' */ |
| 24525 | |
| 24526 | /* DataTypeConversion: '<S228>/Data Type Conversion5' */ |
| 24527 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f.LA_Lanemark_Type); |
| 24528 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24529 | tmp = 0.0F; |
| 24530 | } else { |
| 24531 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24532 | } |
| 24533 | |
| 24534 | fusionAlg_B.LA_LaneMark_Type_n2 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 24535 | -tmp : (uint32_T)tmp; |
| 24536 | |
| 24537 | /* End of DataTypeConversion: '<S228>/Data Type Conversion5' */ |
| 24538 | |
| 24539 | /* DataTypeConversion: '<S228>/Data Type Conversion6' */ |
| 24540 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f.LA_Lanemark_Type_Conf); |
| 24541 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24542 | tmp = 0.0F; |
| 24543 | } else { |
| 24544 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24545 | } |
| 24546 | |
| 24547 | fusionAlg_B.LA_LaneMark_Type_Conf_f = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24548 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24549 | |
| 24550 | /* End of DataTypeConversion: '<S228>/Data Type Conversion6' */ |
| 24551 | |
| 24552 | /* DataTypeConversion: '<S228>/Data Type Conversion7' */ |
| 24553 | tmp = (real32_T)floor(fusionAlg_B.Selector5_f.LA_DLM_Type); |
| 24554 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24555 | tmp = 0.0F; |
| 24556 | } else { |
| 24557 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24558 | } |
| 24559 | |
| 24560 | fusionAlg_B.BusCreator1_lc.ladlmtype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24561 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24562 | |
| 24563 | /* End of DataTypeConversion: '<S228>/Data Type Conversion7' */ |
| 24564 | |
| 24565 | /* BusCreator: '<S228>/Bus Creator1' */ |
| 24566 | fusionAlg_B.BusCreator1_lc.lhlinefirstC0 = fusionAlg_B.Selector5_f.LA_Line_C0; |
| 24567 | fusionAlg_B.BusCreator1_lc.lhlinefirstC1 = fusionAlg_B.Selector5_f.LA_Line_C1; |
| 24568 | fusionAlg_B.BusCreator1_lc.lhlinefirstC2 = fusionAlg_B.Selector5_f.LA_Line_C2; |
| 24569 | fusionAlg_B.BusCreator1_lc.lhlinefirstC3 = fusionAlg_B.Selector5_f.LA_Line_C3; |
| 24570 | fusionAlg_B.BusCreator1_lc.color = fusionAlg_B.LA_Color_l; |
| 24571 | fusionAlg_B.BusCreator1_lc.colorconf = fusionAlg_B.LA_Color_Conf_hj; |
| 24572 | fusionAlg_B.BusCreator1_lc.lanemarkerwidth = |
| 24573 | fusionAlg_B.Selector5_f.LA_Marker_Width; |
| 24574 | fusionAlg_B.BusCreator1_lc.lanemarkerwidthSTD = |
| 24575 | fusionAlg_B.Selector5_f.LA_Marker_Width_STD; |
| 24576 | fusionAlg_B.BusCreator1_lc.lavrstart = |
| 24577 | fusionAlg_B.Selector5_f.LA_View_Range_Start; |
| 24578 | fusionAlg_B.BusCreator1_lc.lavrend = fusionAlg_B.Selector5_f.LA_View_Range_End; |
| 24579 | fusionAlg_B.BusCreator1_lc.laexistprobalility = |
| 24580 | fusionAlg_B.Selector5_f.LA_Exist_Probability; |
| 24581 | fusionAlg_B.BusCreator1_lc.lalanemarktype = fusionAlg_B.LA_LaneMark_Type_n2; |
| 24582 | fusionAlg_B.BusCreator1_lc.lalanemarktypeconf = |
| 24583 | fusionAlg_B.LA_LaneMark_Type_Conf_f; |
| 24584 | |
| 24585 | /* BusCreator: '<S222>/Bus Creator' incorporates: |
| 24586 | * Constant: '<S222>/Constant10' |
| 24587 | * Constant: '<S222>/Constant6' |
| 24588 | * Constant: '<S222>/Constant7' |
| 24589 | * Constant: '<S222>/Constant8' |
| 24590 | * Constant: '<S222>/Constant9' |
| 24591 | */ |
| 24592 | fusionAlg_B.BusCreator_n.timestamp = fusionAlg_P_g.Constant8_Value; |
| 24593 | fusionAlg_B.BusCreator_n.frameNum = fusionAlg_P_g.Constant9_Value; |
| 24594 | fusionAlg_B.BusCreator_n.laneChangeStatus = fusionAlg_P_g.Constant10_Value; |
| 24595 | fusionAlg_B.BusCreator_n.laneHostProtHeader = fusionAlg_B.BusCreator1_ky; |
| 24596 | fusionAlg_B.BusCreator_n.laneHostProtA = fusionAlg_B.BusCreator1_d; |
| 24597 | fusionAlg_B.BusCreator_n.laneHostProtB = fusionAlg_B.BusCreator1_lt; |
| 24598 | fusionAlg_B.BusCreator_n.laneAdjaProtA = fusionAlg_B.BusCreator1_i; |
| 24599 | fusionAlg_B.BusCreator_n.laneAdjaProtB = fusionAlg_B.BusCreator1_h; |
| 24600 | fusionAlg_B.BusCreator_n.laneAdjaProtC = fusionAlg_B.BusCreator1_l; |
| 24601 | fusionAlg_B.BusCreator_n.laneAdjaProtD = fusionAlg_B.BusCreator1_lc; |
| 24602 | fusionAlg_B.BusCreator_n.errorFlag = fusionAlg_P_g.Constant6_Value_mj; |
| 24603 | fusionAlg_B.BusCreator_n.reserved = fusionAlg_P_g.Constant7_Value; |
| 24604 | |
| 24605 | /* Selector: '<S223>/Selector' incorporates: |
| 24606 | * Constant: '<S223>/Constant' |
| 24607 | */ |
| 24608 | fusionAlg_B.Selector = rtu_EyeQ4_Info_st-> |
| 24609 | OBJ_BUS[fusionAlg_P_g.Constant_Value_nj]; |
| 24610 | |
| 24611 | /* DataTypeConversion: '<S232>/Data Type Conversion' */ |
| 24612 | tmp = (real32_T)floor(fusionAlg_B.Selector.OBJ_ID); |
| 24613 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24614 | tmp = 0.0F; |
| 24615 | } else { |
| 24616 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24617 | } |
| 24618 | |
| 24619 | fusionAlg_B.ObjList.vision_01_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24620 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24621 | |
| 24622 | /* End of DataTypeConversion: '<S232>/Data Type Conversion' */ |
| 24623 | |
| 24624 | /* Lookup_n-D: '<S283>/1-D Lookup Table' */ |
| 24625 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector.OBJ_Measuring_Status, |
| 24626 | fusionAlg_P_g.uDLookupTable_bp01Data, 7U); |
| 24627 | fusionAlg_B.Obj_Status_cu = fusionAlg_P_g.uDLookupTable_tableData[bpIdx]; |
| 24628 | |
| 24629 | /* DataTypeConversion: '<S283>/Data Type Conversion1' */ |
| 24630 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_cu); |
| 24631 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24632 | tmp = 0.0F; |
| 24633 | } else { |
| 24634 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24635 | } |
| 24636 | |
| 24637 | fusionAlg_B.ObjList.vision_01_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 24638 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 24639 | |
| 24640 | /* End of DataTypeConversion: '<S283>/Data Type Conversion1' */ |
| 24641 | |
| 24642 | /* DataTypeConversion: '<S274>/Data Type Conversion' */ |
| 24643 | tmp = (real32_T)floor(fusionAlg_B.Selector.OBJ_Object_Age); |
| 24644 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24645 | tmp = 0.0F; |
| 24646 | } else { |
| 24647 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 24648 | } |
| 24649 | |
| 24650 | fusionAlg_B.measureAge = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T)-(int16_T) |
| 24651 | (uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 24652 | |
| 24653 | /* End of DataTypeConversion: '<S274>/Data Type Conversion' */ |
| 24654 | |
| 24655 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' incorporates: |
| 24656 | * Constant: '<S274>/Constant' |
| 24657 | * Constant: '<S274>/Constant1' |
| 24658 | */ |
| 24659 | fusionAlg_B.ObjList.vision_01_obj.obj_stageAge.totalAge = |
| 24660 | fusionAlg_B.measureAge; |
| 24661 | fusionAlg_B.ObjList.vision_01_obj.obj_stageAge.initAge = |
| 24662 | fusionAlg_P_g.Constant_Value_ee; |
| 24663 | fusionAlg_B.ObjList.vision_01_obj.obj_stageAge.measureAge = |
| 24664 | fusionAlg_B.measureAge; |
| 24665 | fusionAlg_B.ObjList.vision_01_obj.obj_stageAge.predictAge = |
| 24666 | fusionAlg_P_g.Constant1_Value_a5; |
| 24667 | |
| 24668 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' incorporates: |
| 24669 | * Constant: '<S275>/Constant' |
| 24670 | * Constant: '<S275>/Constant1' |
| 24671 | * Constant: '<S275>/Constant2' |
| 24672 | * Constant: '<S275>/Constant3' |
| 24673 | */ |
| 24674 | fusionAlg_B.ObjList.vision_01_obj.obj_boundary.X1 = |
| 24675 | fusionAlg_P_g.Constant_Value_ew; |
| 24676 | fusionAlg_B.ObjList.vision_01_obj.obj_boundary.Y1 = |
| 24677 | fusionAlg_P_g.Constant1_Value_o; |
| 24678 | fusionAlg_B.ObjList.vision_01_obj.obj_boundary.X2 = |
| 24679 | fusionAlg_P_g.Constant2_Value_dl; |
| 24680 | fusionAlg_B.ObjList.vision_01_obj.obj_boundary.Y2 = |
| 24681 | fusionAlg_P_g.Constant3_Value_kw; |
| 24682 | |
| 24683 | /* Lookup_n-D: '<S284>/1-D Lookup Table' */ |
| 24684 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector.OBJ_Object_Class, |
| 24685 | fusionAlg_P_g.uDLookupTable_bp01Data_l, 8U); |
| 24686 | fusionAlg_B.Obj_Status_pz = fusionAlg_P_g.uDLookupTable_tableData_n[bpIdx]; |
| 24687 | |
| 24688 | /* DataTypeConversion: '<S284>/Data Type Conversion2' */ |
| 24689 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_pz); |
| 24690 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24691 | tmp = 0.0F; |
| 24692 | } else { |
| 24693 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24694 | } |
| 24695 | |
| 24696 | fusionAlg_B.Obj_Type = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24697 | (uint32_T)tmp; |
| 24698 | |
| 24699 | /* End of DataTypeConversion: '<S284>/Data Type Conversion2' */ |
| 24700 | |
| 24701 | /* DataTypeConversion: '<S232>/Data Type Conversion3' */ |
| 24702 | tmp = (real32_T)floor(fusionAlg_B.Selector.OBJ_Class_Probability); |
| 24703 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24704 | tmp = 0.0F; |
| 24705 | } else { |
| 24706 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24707 | } |
| 24708 | |
| 24709 | fusionAlg_B.Obj_TypeConf = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24710 | (uint32_T)tmp; |
| 24711 | |
| 24712 | /* End of DataTypeConversion: '<S232>/Data Type Conversion3' */ |
| 24713 | |
| 24714 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' */ |
| 24715 | fusionAlg_B.ObjList.vision_01_obj.obj_coordinate.lateral = |
| 24716 | fusionAlg_B.Selector.OBJ_Lat_Distance; |
| 24717 | fusionAlg_B.ObjList.vision_01_obj.obj_coordinate.lateralVariance = |
| 24718 | fusionAlg_B.Selector.OBJ_Lat_Distance_STD; |
| 24719 | fusionAlg_B.ObjList.vision_01_obj.obj_coordinate.longitudinal = |
| 24720 | fusionAlg_B.Selector.OBJ_Long_Distance; |
| 24721 | fusionAlg_B.ObjList.vision_01_obj.obj_coordinate.longitudinalVariance = |
| 24722 | fusionAlg_B.Selector.OBJ_Long_Distance_STD; |
| 24723 | |
| 24724 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' */ |
| 24725 | fusionAlg_B.ObjList.vision_01_obj.obj_velocity.Vx = |
| 24726 | fusionAlg_B.Selector.OBJ_Abs_Long_Velocity; |
| 24727 | fusionAlg_B.ObjList.vision_01_obj.obj_velocity.VxVariance = |
| 24728 | fusionAlg_B.Selector.OBJ_Abs_Long_Velocity_STD; |
| 24729 | fusionAlg_B.ObjList.vision_01_obj.obj_velocity.Vy = |
| 24730 | fusionAlg_B.Selector.OBJ_Abs_Lat_Velocity; |
| 24731 | fusionAlg_B.ObjList.vision_01_obj.obj_velocity.VyVariance = |
| 24732 | fusionAlg_B.Selector.OBJ_Abs_Lat_Velocity_STD; |
| 24733 | |
| 24734 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' */ |
| 24735 | fusionAlg_B.ObjList.vision_01_obj.obj_angleOfCenter.centerAngle = |
| 24736 | fusionAlg_B.Selector.OBJ_Angle_Mid; |
| 24737 | fusionAlg_B.ObjList.vision_01_obj.obj_angleOfCenter.centerAngleVariance = |
| 24738 | fusionAlg_B.Selector.OBJ_Angle_Mid_STD; |
| 24739 | |
| 24740 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' */ |
| 24741 | fusionAlg_B.ObjList.vision_01_obj.obj_acceleration.Ax = |
| 24742 | fusionAlg_B.Selector.OBJ_Abs_Long_Acc; |
| 24743 | fusionAlg_B.ObjList.vision_01_obj.obj_acceleration.AxVariance = |
| 24744 | fusionAlg_B.Selector.OBJ_Abs_Long_Acc_STD; |
| 24745 | fusionAlg_B.ObjList.vision_01_obj.obj_acceleration.Ay = |
| 24746 | fusionAlg_B.Selector.OBJ_Abs_Lat_Acc; |
| 24747 | fusionAlg_B.ObjList.vision_01_obj.obj_acceleration.AyVariance = |
| 24748 | fusionAlg_B.Selector.OBJ_Abs_Lat_Acc_STD; |
| 24749 | |
| 24750 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' */ |
| 24751 | fusionAlg_B.ObjList.vision_01_obj.AyVariance.length = |
| 24752 | fusionAlg_B.Selector.OBJ_Length; |
| 24753 | fusionAlg_B.ObjList.vision_01_obj.AyVariance.width = |
| 24754 | fusionAlg_B.Selector.OBJ_Width; |
| 24755 | fusionAlg_B.ObjList.vision_01_obj.AyVariance.height = |
| 24756 | fusionAlg_B.Selector.OBJ_Height; |
| 24757 | |
| 24758 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' incorporates: |
| 24759 | * Constant: '<S281>/Constant1' |
| 24760 | * Constant: '<S281>/Constant2' |
| 24761 | * Constant: '<S281>/Constant3' |
| 24762 | */ |
| 24763 | fusionAlg_B.ObjList.vision_01_obj.reserved1.reserved0 = |
| 24764 | fusionAlg_P_g.Constant2_Value_iy; |
| 24765 | fusionAlg_B.ObjList.vision_01_obj.reserved1.reserved1 = |
| 24766 | fusionAlg_P_g.Constant1_Value_he; |
| 24767 | fusionAlg_B.ObjList.vision_01_obj.reserved1.reserved2 = |
| 24768 | fusionAlg_P_g.Constant3_Value_ce; |
| 24769 | |
| 24770 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' incorporates: |
| 24771 | * Constant: '<S282>/Constant5' |
| 24772 | * Constant: '<S282>/Constant6' |
| 24773 | */ |
| 24774 | fusionAlg_B.ObjList.vision_01_obj.reserved2.reserved0 = |
| 24775 | fusionAlg_P_g.Constant5_Value_ab; |
| 24776 | fusionAlg_B.ObjList.vision_01_obj.reserved2.reserved1 = |
| 24777 | fusionAlg_P_g.Constant6_Value_iv; |
| 24778 | |
| 24779 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_0' incorporates: |
| 24780 | * Constant: '<S232>/Constant' |
| 24781 | * Constant: '<S232>/Constant1' |
| 24782 | * Constant: '<S232>/Constant2' |
| 24783 | * Constant: '<S232>/Constant3' |
| 24784 | * Constant: '<S232>/Constant4' |
| 24785 | */ |
| 24786 | fusionAlg_B.ObjList.vision_01_obj.obj_type = fusionAlg_B.Obj_Type; |
| 24787 | fusionAlg_B.ObjList.vision_01_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf; |
| 24788 | fusionAlg_B.ObjList.vision_01_obj.obj_TTC = fusionAlg_B.Selector.OBJ_Inv_TTC; |
| 24789 | fusionAlg_B.ObjList.vision_01_obj.obj_TTCVariance = |
| 24790 | fusionAlg_B.Selector.OBJ_Inv_TTC_STD; |
| 24791 | fusionAlg_B.ObjList.vision_01_obj.obj_existProb = fusionAlg_P_g.Constant_Value; |
| 24792 | fusionAlg_B.ObjList.vision_01_obj.obj_angleOfObject = |
| 24793 | fusionAlg_P_g.Constant1_Value_ggc; |
| 24794 | fusionAlg_B.ObjList.vision_01_obj.obj_Heading = |
| 24795 | fusionAlg_B.Selector.OBJ_Heading; |
| 24796 | fusionAlg_B.ObjList.vision_01_obj.obj_Heading_STD = |
| 24797 | fusionAlg_P_g.Constant2_Value_ky; |
| 24798 | fusionAlg_B.ObjList.vision_01_obj.obj_Heading_V = |
| 24799 | fusionAlg_P_g.Constant3_Value_mzj; |
| 24800 | fusionAlg_B.ObjList.vision_01_obj.obj_Heading_STD_V = |
| 24801 | fusionAlg_P_g.Constant4_Value_foo; |
| 24802 | |
| 24803 | /* Selector: '<S223>/Selector1' incorporates: |
| 24804 | * Constant: '<S223>/Constant1' |
| 24805 | */ |
| 24806 | fusionAlg_B.Selector1 = rtu_EyeQ4_Info_st-> |
| 24807 | OBJ_BUS[fusionAlg_P_g.Constant1_Value_of]; |
| 24808 | |
| 24809 | /* DataTypeConversion: '<S243>/Data Type Conversion' */ |
| 24810 | tmp = (real32_T)floor(fusionAlg_B.Selector1.OBJ_ID); |
| 24811 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24812 | tmp = 0.0F; |
| 24813 | } else { |
| 24814 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24815 | } |
| 24816 | |
| 24817 | fusionAlg_B.ObjList.vision_02_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 24818 | (uint32_T)-tmp : (uint32_T)tmp; |
| 24819 | |
| 24820 | /* End of DataTypeConversion: '<S243>/Data Type Conversion' */ |
| 24821 | |
| 24822 | /* Lookup_n-D: '<S404>/1-D Lookup Table' */ |
| 24823 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector1.OBJ_Measuring_Status, |
| 24824 | fusionAlg_P_g.uDLookupTable_bp01Data_k, 7U); |
| 24825 | fusionAlg_B.Obj_Status_ef = fusionAlg_P_g.uDLookupTable_tableData_h[bpIdx]; |
| 24826 | |
| 24827 | /* DataTypeConversion: '<S404>/Data Type Conversion1' */ |
| 24828 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ef); |
| 24829 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24830 | tmp = 0.0F; |
| 24831 | } else { |
| 24832 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24833 | } |
| 24834 | |
| 24835 | fusionAlg_B.ObjList.vision_02_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 24836 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 24837 | |
| 24838 | /* End of DataTypeConversion: '<S404>/Data Type Conversion1' */ |
| 24839 | |
| 24840 | /* DataTypeConversion: '<S395>/Data Type Conversion' */ |
| 24841 | tmp = (real32_T)floor(fusionAlg_B.Selector1.OBJ_Object_Age); |
| 24842 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24843 | tmp = 0.0F; |
| 24844 | } else { |
| 24845 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 24846 | } |
| 24847 | |
| 24848 | fusionAlg_B.measureAge_o = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 24849 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 24850 | |
| 24851 | /* End of DataTypeConversion: '<S395>/Data Type Conversion' */ |
| 24852 | |
| 24853 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' incorporates: |
| 24854 | * Constant: '<S395>/Constant' |
| 24855 | * Constant: '<S395>/Constant1' |
| 24856 | */ |
| 24857 | fusionAlg_B.ObjList.vision_02_obj.obj_stageAge.totalAge = |
| 24858 | fusionAlg_B.measureAge_o; |
| 24859 | fusionAlg_B.ObjList.vision_02_obj.obj_stageAge.initAge = |
| 24860 | fusionAlg_P_g.Constant_Value_dkb; |
| 24861 | fusionAlg_B.ObjList.vision_02_obj.obj_stageAge.measureAge = |
| 24862 | fusionAlg_B.measureAge_o; |
| 24863 | fusionAlg_B.ObjList.vision_02_obj.obj_stageAge.predictAge = |
| 24864 | fusionAlg_P_g.Constant1_Value_f1; |
| 24865 | |
| 24866 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' incorporates: |
| 24867 | * Constant: '<S396>/Constant' |
| 24868 | * Constant: '<S396>/Constant1' |
| 24869 | * Constant: '<S396>/Constant2' |
| 24870 | * Constant: '<S396>/Constant3' |
| 24871 | */ |
| 24872 | fusionAlg_B.ObjList.vision_02_obj.obj_boundary.X1 = |
| 24873 | fusionAlg_P_g.Constant_Value_gn; |
| 24874 | fusionAlg_B.ObjList.vision_02_obj.obj_boundary.Y1 = |
| 24875 | fusionAlg_P_g.Constant1_Value_e; |
| 24876 | fusionAlg_B.ObjList.vision_02_obj.obj_boundary.X2 = |
| 24877 | fusionAlg_P_g.Constant2_Value_pd; |
| 24878 | fusionAlg_B.ObjList.vision_02_obj.obj_boundary.Y2 = |
| 24879 | fusionAlg_P_g.Constant3_Value_ko; |
| 24880 | |
| 24881 | /* Lookup_n-D: '<S405>/1-D Lookup Table' */ |
| 24882 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector1.OBJ_Object_Class, |
| 24883 | fusionAlg_P_g.uDLookupTable_bp01Data_lj, 8U); |
| 24884 | fusionAlg_B.Obj_Status_at = fusionAlg_P_g.uDLookupTable_tableData_c[bpIdx]; |
| 24885 | |
| 24886 | /* DataTypeConversion: '<S405>/Data Type Conversion2' */ |
| 24887 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_at); |
| 24888 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24889 | tmp = 0.0F; |
| 24890 | } else { |
| 24891 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24892 | } |
| 24893 | |
| 24894 | fusionAlg_B.Obj_Type_m = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24895 | (uint32_T)tmp; |
| 24896 | |
| 24897 | /* End of DataTypeConversion: '<S405>/Data Type Conversion2' */ |
| 24898 | |
| 24899 | /* DataTypeConversion: '<S243>/Data Type Conversion3' */ |
| 24900 | tmp = (real32_T)floor(fusionAlg_B.Selector1.OBJ_Class_Probability); |
| 24901 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 24902 | tmp = 0.0F; |
| 24903 | } else { |
| 24904 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 24905 | } |
| 24906 | |
| 24907 | fusionAlg_B.Obj_TypeConf_d = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 24908 | (uint32_T)tmp; |
| 24909 | |
| 24910 | /* End of DataTypeConversion: '<S243>/Data Type Conversion3' */ |
| 24911 | |
| 24912 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' */ |
| 24913 | fusionAlg_B.ObjList.vision_02_obj.obj_coordinate.lateral = |
| 24914 | fusionAlg_B.Selector1.OBJ_Lat_Distance; |
| 24915 | fusionAlg_B.ObjList.vision_02_obj.obj_coordinate.lateralVariance = |
| 24916 | fusionAlg_B.Selector1.OBJ_Lat_Distance_STD; |
| 24917 | fusionAlg_B.ObjList.vision_02_obj.obj_coordinate.longitudinal = |
| 24918 | fusionAlg_B.Selector1.OBJ_Long_Distance; |
| 24919 | fusionAlg_B.ObjList.vision_02_obj.obj_coordinate.longitudinalVariance = |
| 24920 | fusionAlg_B.Selector1.OBJ_Long_Distance_STD; |
| 24921 | |
| 24922 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' */ |
| 24923 | fusionAlg_B.ObjList.vision_02_obj.obj_velocity.Vx = |
| 24924 | fusionAlg_B.Selector1.OBJ_Abs_Long_Velocity; |
| 24925 | fusionAlg_B.ObjList.vision_02_obj.obj_velocity.VxVariance = |
| 24926 | fusionAlg_B.Selector1.OBJ_Abs_Long_Velocity_STD; |
| 24927 | fusionAlg_B.ObjList.vision_02_obj.obj_velocity.Vy = |
| 24928 | fusionAlg_B.Selector1.OBJ_Abs_Lat_Velocity; |
| 24929 | fusionAlg_B.ObjList.vision_02_obj.obj_velocity.VyVariance = |
| 24930 | fusionAlg_B.Selector1.OBJ_Abs_Lat_Velocity_STD; |
| 24931 | |
| 24932 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' */ |
| 24933 | fusionAlg_B.ObjList.vision_02_obj.obj_angleOfCenter.centerAngle = |
| 24934 | fusionAlg_B.Selector1.OBJ_Angle_Mid; |
| 24935 | fusionAlg_B.ObjList.vision_02_obj.obj_angleOfCenter.centerAngleVariance = |
| 24936 | fusionAlg_B.Selector1.OBJ_Angle_Mid_STD; |
| 24937 | |
| 24938 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' */ |
| 24939 | fusionAlg_B.ObjList.vision_02_obj.obj_acceleration.Ax = |
| 24940 | fusionAlg_B.Selector1.OBJ_Abs_Long_Acc; |
| 24941 | fusionAlg_B.ObjList.vision_02_obj.obj_acceleration.AxVariance = |
| 24942 | fusionAlg_B.Selector1.OBJ_Abs_Long_Acc_STD; |
| 24943 | fusionAlg_B.ObjList.vision_02_obj.obj_acceleration.Ay = |
| 24944 | fusionAlg_B.Selector1.OBJ_Abs_Lat_Acc; |
| 24945 | fusionAlg_B.ObjList.vision_02_obj.obj_acceleration.AyVariance = |
| 24946 | fusionAlg_B.Selector1.OBJ_Abs_Lat_Acc_STD; |
| 24947 | |
| 24948 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' */ |
| 24949 | fusionAlg_B.ObjList.vision_02_obj.AyVariance.length = |
| 24950 | fusionAlg_B.Selector1.OBJ_Length; |
| 24951 | fusionAlg_B.ObjList.vision_02_obj.AyVariance.width = |
| 24952 | fusionAlg_B.Selector1.OBJ_Width; |
| 24953 | fusionAlg_B.ObjList.vision_02_obj.AyVariance.height = |
| 24954 | fusionAlg_B.Selector1.OBJ_Height; |
| 24955 | |
| 24956 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' incorporates: |
| 24957 | * Constant: '<S402>/Constant1' |
| 24958 | * Constant: '<S402>/Constant2' |
| 24959 | * Constant: '<S402>/Constant3' |
| 24960 | */ |
| 24961 | fusionAlg_B.ObjList.vision_02_obj.reserved1.reserved0 = |
| 24962 | fusionAlg_P_g.Constant2_Value_l0; |
| 24963 | fusionAlg_B.ObjList.vision_02_obj.reserved1.reserved1 = |
| 24964 | fusionAlg_P_g.Constant1_Value_edp; |
| 24965 | fusionAlg_B.ObjList.vision_02_obj.reserved1.reserved2 = |
| 24966 | fusionAlg_P_g.Constant3_Value_pmd; |
| 24967 | |
| 24968 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' incorporates: |
| 24969 | * Constant: '<S403>/Constant5' |
| 24970 | * Constant: '<S403>/Constant6' |
| 24971 | */ |
| 24972 | fusionAlg_B.ObjList.vision_02_obj.reserved2.reserved0 = |
| 24973 | fusionAlg_P_g.Constant5_Value_kh; |
| 24974 | fusionAlg_B.ObjList.vision_02_obj.reserved2.reserved1 = |
| 24975 | fusionAlg_P_g.Constant6_Value_kj; |
| 24976 | |
| 24977 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_1' incorporates: |
| 24978 | * Constant: '<S243>/Constant' |
| 24979 | * Constant: '<S243>/Constant1' |
| 24980 | * Constant: '<S243>/Constant2' |
| 24981 | * Constant: '<S243>/Constant3' |
| 24982 | * Constant: '<S243>/Constant4' |
| 24983 | */ |
| 24984 | fusionAlg_B.ObjList.vision_02_obj.obj_type = fusionAlg_B.Obj_Type_m; |
| 24985 | fusionAlg_B.ObjList.vision_02_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_d; |
| 24986 | fusionAlg_B.ObjList.vision_02_obj.obj_TTC = fusionAlg_B.Selector1.OBJ_Inv_TTC; |
| 24987 | fusionAlg_B.ObjList.vision_02_obj.obj_TTCVariance = |
| 24988 | fusionAlg_B.Selector1.OBJ_Inv_TTC_STD; |
| 24989 | fusionAlg_B.ObjList.vision_02_obj.obj_existProb = |
| 24990 | fusionAlg_P_g.Constant_Value_e; |
| 24991 | fusionAlg_B.ObjList.vision_02_obj.obj_angleOfObject = |
| 24992 | fusionAlg_P_g.Constant1_Value_h4g; |
| 24993 | fusionAlg_B.ObjList.vision_02_obj.obj_Heading = |
| 24994 | fusionAlg_B.Selector1.OBJ_Heading; |
| 24995 | fusionAlg_B.ObjList.vision_02_obj.obj_Heading_STD = |
| 24996 | fusionAlg_P_g.Constant2_Value_ga; |
| 24997 | fusionAlg_B.ObjList.vision_02_obj.obj_Heading_V = |
| 24998 | fusionAlg_P_g.Constant3_Value_myk; |
| 24999 | fusionAlg_B.ObjList.vision_02_obj.obj_Heading_STD_V = |
| 25000 | fusionAlg_P_g.Constant4_Value_cyb; |
| 25001 | |
| 25002 | /* Selector: '<S223>/Selector2' incorporates: |
| 25003 | * Constant: '<S223>/Constant2' |
| 25004 | */ |
| 25005 | fusionAlg_B.Selector2 = rtu_EyeQ4_Info_st-> |
| 25006 | OBJ_BUS[fusionAlg_P_g.Constant2_Value_di]; |
| 25007 | |
| 25008 | /* DataTypeConversion: '<S254>/Data Type Conversion' */ |
| 25009 | tmp = (real32_T)floor(fusionAlg_B.Selector2.OBJ_ID); |
| 25010 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25011 | tmp = 0.0F; |
| 25012 | } else { |
| 25013 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25014 | } |
| 25015 | |
| 25016 | fusionAlg_B.ObjList.vision_03_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 25017 | (uint32_T)-tmp : (uint32_T)tmp; |
| 25018 | |
| 25019 | /* End of DataTypeConversion: '<S254>/Data Type Conversion' */ |
| 25020 | |
| 25021 | /* Lookup_n-D: '<S525>/1-D Lookup Table' */ |
| 25022 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector2.OBJ_Measuring_Status, |
| 25023 | fusionAlg_P_g.uDLookupTable_bp01Data_n, 7U); |
| 25024 | fusionAlg_B.Obj_Status_ba = fusionAlg_P_g.uDLookupTable_tableData_o[bpIdx]; |
| 25025 | |
| 25026 | /* DataTypeConversion: '<S525>/Data Type Conversion1' */ |
| 25027 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ba); |
| 25028 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25029 | tmp = 0.0F; |
| 25030 | } else { |
| 25031 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25032 | } |
| 25033 | |
| 25034 | fusionAlg_B.ObjList.vision_03_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 25035 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 25036 | |
| 25037 | /* End of DataTypeConversion: '<S525>/Data Type Conversion1' */ |
| 25038 | |
| 25039 | /* DataTypeConversion: '<S516>/Data Type Conversion' */ |
| 25040 | tmp = (real32_T)floor(fusionAlg_B.Selector2.OBJ_Object_Age); |
| 25041 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25042 | tmp = 0.0F; |
| 25043 | } else { |
| 25044 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 25045 | } |
| 25046 | |
| 25047 | fusionAlg_B.measureAge_a = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 25048 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 25049 | |
| 25050 | /* End of DataTypeConversion: '<S516>/Data Type Conversion' */ |
| 25051 | |
| 25052 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' incorporates: |
| 25053 | * Constant: '<S516>/Constant' |
| 25054 | * Constant: '<S516>/Constant1' |
| 25055 | */ |
| 25056 | fusionAlg_B.ObjList.vision_03_obj.obj_stageAge.totalAge = |
| 25057 | fusionAlg_B.measureAge_a; |
| 25058 | fusionAlg_B.ObjList.vision_03_obj.obj_stageAge.initAge = |
| 25059 | fusionAlg_P_g.Constant_Value_bf; |
| 25060 | fusionAlg_B.ObjList.vision_03_obj.obj_stageAge.measureAge = |
| 25061 | fusionAlg_B.measureAge_a; |
| 25062 | fusionAlg_B.ObjList.vision_03_obj.obj_stageAge.predictAge = |
| 25063 | fusionAlg_P_g.Constant1_Value_kg; |
| 25064 | |
| 25065 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' incorporates: |
| 25066 | * Constant: '<S517>/Constant' |
| 25067 | * Constant: '<S517>/Constant1' |
| 25068 | * Constant: '<S517>/Constant2' |
| 25069 | * Constant: '<S517>/Constant3' |
| 25070 | */ |
| 25071 | fusionAlg_B.ObjList.vision_03_obj.obj_boundary.X1 = |
| 25072 | fusionAlg_P_g.Constant_Value_mt; |
| 25073 | fusionAlg_B.ObjList.vision_03_obj.obj_boundary.Y1 = |
| 25074 | fusionAlg_P_g.Constant1_Value_cj; |
| 25075 | fusionAlg_B.ObjList.vision_03_obj.obj_boundary.X2 = |
| 25076 | fusionAlg_P_g.Constant2_Value_ju; |
| 25077 | fusionAlg_B.ObjList.vision_03_obj.obj_boundary.Y2 = |
| 25078 | fusionAlg_P_g.Constant3_Value_pm; |
| 25079 | |
| 25080 | /* Lookup_n-D: '<S526>/1-D Lookup Table' */ |
| 25081 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector2.OBJ_Object_Class, |
| 25082 | fusionAlg_P_g.uDLookupTable_bp01Data_ljz, 8U); |
| 25083 | fusionAlg_B.Obj_Status_o = fusionAlg_P_g.uDLookupTable_tableData_m[bpIdx]; |
| 25084 | |
| 25085 | /* DataTypeConversion: '<S526>/Data Type Conversion2' */ |
| 25086 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_o); |
| 25087 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25088 | tmp = 0.0F; |
| 25089 | } else { |
| 25090 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25091 | } |
| 25092 | |
| 25093 | fusionAlg_B.Obj_Type_d = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25094 | (uint32_T)tmp; |
| 25095 | |
| 25096 | /* End of DataTypeConversion: '<S526>/Data Type Conversion2' */ |
| 25097 | |
| 25098 | /* DataTypeConversion: '<S254>/Data Type Conversion3' */ |
| 25099 | tmp = (real32_T)floor(fusionAlg_B.Selector2.OBJ_Class_Probability); |
| 25100 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25101 | tmp = 0.0F; |
| 25102 | } else { |
| 25103 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25104 | } |
| 25105 | |
| 25106 | fusionAlg_B.Obj_TypeConf_b = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25107 | (uint32_T)tmp; |
| 25108 | |
| 25109 | /* End of DataTypeConversion: '<S254>/Data Type Conversion3' */ |
| 25110 | |
| 25111 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' */ |
| 25112 | fusionAlg_B.ObjList.vision_03_obj.obj_coordinate.lateral = |
| 25113 | fusionAlg_B.Selector2.OBJ_Lat_Distance; |
| 25114 | fusionAlg_B.ObjList.vision_03_obj.obj_coordinate.lateralVariance = |
| 25115 | fusionAlg_B.Selector2.OBJ_Lat_Distance_STD; |
| 25116 | fusionAlg_B.ObjList.vision_03_obj.obj_coordinate.longitudinal = |
| 25117 | fusionAlg_B.Selector2.OBJ_Long_Distance; |
| 25118 | fusionAlg_B.ObjList.vision_03_obj.obj_coordinate.longitudinalVariance = |
| 25119 | fusionAlg_B.Selector2.OBJ_Long_Distance_STD; |
| 25120 | |
| 25121 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' */ |
| 25122 | fusionAlg_B.ObjList.vision_03_obj.obj_velocity.Vx = |
| 25123 | fusionAlg_B.Selector2.OBJ_Abs_Long_Velocity; |
| 25124 | fusionAlg_B.ObjList.vision_03_obj.obj_velocity.VxVariance = |
| 25125 | fusionAlg_B.Selector2.OBJ_Abs_Long_Velocity_STD; |
| 25126 | fusionAlg_B.ObjList.vision_03_obj.obj_velocity.Vy = |
| 25127 | fusionAlg_B.Selector2.OBJ_Abs_Lat_Velocity; |
| 25128 | fusionAlg_B.ObjList.vision_03_obj.obj_velocity.VyVariance = |
| 25129 | fusionAlg_B.Selector2.OBJ_Abs_Lat_Velocity_STD; |
| 25130 | |
| 25131 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' */ |
| 25132 | fusionAlg_B.ObjList.vision_03_obj.obj_angleOfCenter.centerAngle = |
| 25133 | fusionAlg_B.Selector2.OBJ_Angle_Mid; |
| 25134 | fusionAlg_B.ObjList.vision_03_obj.obj_angleOfCenter.centerAngleVariance = |
| 25135 | fusionAlg_B.Selector2.OBJ_Angle_Mid_STD; |
| 25136 | |
| 25137 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' */ |
| 25138 | fusionAlg_B.ObjList.vision_03_obj.obj_acceleration.Ax = |
| 25139 | fusionAlg_B.Selector2.OBJ_Abs_Long_Acc; |
| 25140 | fusionAlg_B.ObjList.vision_03_obj.obj_acceleration.AxVariance = |
| 25141 | fusionAlg_B.Selector2.OBJ_Abs_Long_Acc_STD; |
| 25142 | fusionAlg_B.ObjList.vision_03_obj.obj_acceleration.Ay = |
| 25143 | fusionAlg_B.Selector2.OBJ_Abs_Lat_Acc; |
| 25144 | fusionAlg_B.ObjList.vision_03_obj.obj_acceleration.AyVariance = |
| 25145 | fusionAlg_B.Selector2.OBJ_Abs_Lat_Acc_STD; |
| 25146 | |
| 25147 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' */ |
| 25148 | fusionAlg_B.ObjList.vision_03_obj.AyVariance.length = |
| 25149 | fusionAlg_B.Selector2.OBJ_Length; |
| 25150 | fusionAlg_B.ObjList.vision_03_obj.AyVariance.width = |
| 25151 | fusionAlg_B.Selector2.OBJ_Width; |
| 25152 | fusionAlg_B.ObjList.vision_03_obj.AyVariance.height = |
| 25153 | fusionAlg_B.Selector2.OBJ_Height; |
| 25154 | |
| 25155 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' incorporates: |
| 25156 | * Constant: '<S523>/Constant1' |
| 25157 | * Constant: '<S523>/Constant2' |
| 25158 | * Constant: '<S523>/Constant3' |
| 25159 | */ |
| 25160 | fusionAlg_B.ObjList.vision_03_obj.reserved1.reserved0 = |
| 25161 | fusionAlg_P_g.Constant2_Value_bt; |
| 25162 | fusionAlg_B.ObjList.vision_03_obj.reserved1.reserved1 = |
| 25163 | fusionAlg_P_g.Constant1_Value_fb5; |
| 25164 | fusionAlg_B.ObjList.vision_03_obj.reserved1.reserved2 = |
| 25165 | fusionAlg_P_g.Constant3_Value_h3; |
| 25166 | |
| 25167 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' incorporates: |
| 25168 | * Constant: '<S524>/Constant5' |
| 25169 | * Constant: '<S524>/Constant6' |
| 25170 | */ |
| 25171 | fusionAlg_B.ObjList.vision_03_obj.reserved2.reserved0 = |
| 25172 | fusionAlg_P_g.Constant5_Value_g2i; |
| 25173 | fusionAlg_B.ObjList.vision_03_obj.reserved2.reserved1 = |
| 25174 | fusionAlg_P_g.Constant6_Value_aod; |
| 25175 | |
| 25176 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_2' incorporates: |
| 25177 | * Constant: '<S254>/Constant' |
| 25178 | * Constant: '<S254>/Constant1' |
| 25179 | * Constant: '<S254>/Constant2' |
| 25180 | * Constant: '<S254>/Constant3' |
| 25181 | * Constant: '<S254>/Constant4' |
| 25182 | */ |
| 25183 | fusionAlg_B.ObjList.vision_03_obj.obj_type = fusionAlg_B.Obj_Type_d; |
| 25184 | fusionAlg_B.ObjList.vision_03_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_b; |
| 25185 | fusionAlg_B.ObjList.vision_03_obj.obj_TTC = fusionAlg_B.Selector2.OBJ_Inv_TTC; |
| 25186 | fusionAlg_B.ObjList.vision_03_obj.obj_TTCVariance = |
| 25187 | fusionAlg_B.Selector2.OBJ_Inv_TTC_STD; |
| 25188 | fusionAlg_B.ObjList.vision_03_obj.obj_existProb = |
| 25189 | fusionAlg_P_g.Constant_Value_i; |
| 25190 | fusionAlg_B.ObjList.vision_03_obj.obj_angleOfObject = |
| 25191 | fusionAlg_P_g.Constant1_Value_i5; |
| 25192 | fusionAlg_B.ObjList.vision_03_obj.obj_Heading = |
| 25193 | fusionAlg_B.Selector2.OBJ_Heading; |
| 25194 | fusionAlg_B.ObjList.vision_03_obj.obj_Heading_STD = |
| 25195 | fusionAlg_P_g.Constant2_Value_ig; |
| 25196 | fusionAlg_B.ObjList.vision_03_obj.obj_Heading_V = |
| 25197 | fusionAlg_P_g.Constant3_Value_gf; |
| 25198 | fusionAlg_B.ObjList.vision_03_obj.obj_Heading_STD_V = |
| 25199 | fusionAlg_P_g.Constant4_Value_lt; |
| 25200 | |
| 25201 | /* Selector: '<S223>/Selector3' incorporates: |
| 25202 | * Constant: '<S223>/Constant3' |
| 25203 | */ |
| 25204 | fusionAlg_B.Selector3 = rtu_EyeQ4_Info_st-> |
| 25205 | OBJ_BUS[fusionAlg_P_g.Constant3_Value_a05]; |
| 25206 | |
| 25207 | /* DataTypeConversion: '<S265>/Data Type Conversion' */ |
| 25208 | tmp = (real32_T)floor(fusionAlg_B.Selector3.OBJ_ID); |
| 25209 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25210 | tmp = 0.0F; |
| 25211 | } else { |
| 25212 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25213 | } |
| 25214 | |
| 25215 | fusionAlg_B.ObjList.vision_04_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 25216 | (uint32_T)-tmp : (uint32_T)tmp; |
| 25217 | |
| 25218 | /* End of DataTypeConversion: '<S265>/Data Type Conversion' */ |
| 25219 | |
| 25220 | /* Lookup_n-D: '<S646>/1-D Lookup Table' */ |
| 25221 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector3.OBJ_Measuring_Status, |
| 25222 | fusionAlg_P_g.uDLookupTable_bp01Data_l0, 7U); |
| 25223 | fusionAlg_B.Obj_Status_ad = fusionAlg_P_g.uDLookupTable_tableData_j[bpIdx]; |
| 25224 | |
| 25225 | /* DataTypeConversion: '<S646>/Data Type Conversion1' */ |
| 25226 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ad); |
| 25227 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25228 | tmp = 0.0F; |
| 25229 | } else { |
| 25230 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25231 | } |
| 25232 | |
| 25233 | fusionAlg_B.ObjList.vision_04_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 25234 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 25235 | |
| 25236 | /* End of DataTypeConversion: '<S646>/Data Type Conversion1' */ |
| 25237 | |
| 25238 | /* DataTypeConversion: '<S637>/Data Type Conversion' */ |
| 25239 | tmp = (real32_T)floor(fusionAlg_B.Selector3.OBJ_Object_Age); |
| 25240 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25241 | tmp = 0.0F; |
| 25242 | } else { |
| 25243 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 25244 | } |
| 25245 | |
| 25246 | fusionAlg_B.measureAge_j = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 25247 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 25248 | |
| 25249 | /* End of DataTypeConversion: '<S637>/Data Type Conversion' */ |
| 25250 | |
| 25251 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' incorporates: |
| 25252 | * Constant: '<S637>/Constant' |
| 25253 | * Constant: '<S637>/Constant1' |
| 25254 | */ |
| 25255 | fusionAlg_B.ObjList.vision_04_obj.obj_stageAge.totalAge = |
| 25256 | fusionAlg_B.measureAge_j; |
| 25257 | fusionAlg_B.ObjList.vision_04_obj.obj_stageAge.initAge = |
| 25258 | fusionAlg_P_g.Constant_Value_fi; |
| 25259 | fusionAlg_B.ObjList.vision_04_obj.obj_stageAge.measureAge = |
| 25260 | fusionAlg_B.measureAge_j; |
| 25261 | fusionAlg_B.ObjList.vision_04_obj.obj_stageAge.predictAge = |
| 25262 | fusionAlg_P_g.Constant1_Value_ca; |
| 25263 | |
| 25264 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' incorporates: |
| 25265 | * Constant: '<S638>/Constant' |
| 25266 | * Constant: '<S638>/Constant1' |
| 25267 | * Constant: '<S638>/Constant2' |
| 25268 | * Constant: '<S638>/Constant3' |
| 25269 | */ |
| 25270 | fusionAlg_B.ObjList.vision_04_obj.obj_boundary.X1 = |
| 25271 | fusionAlg_P_g.Constant_Value_po; |
| 25272 | fusionAlg_B.ObjList.vision_04_obj.obj_boundary.Y1 = |
| 25273 | fusionAlg_P_g.Constant1_Value_n; |
| 25274 | fusionAlg_B.ObjList.vision_04_obj.obj_boundary.X2 = |
| 25275 | fusionAlg_P_g.Constant2_Value_c5; |
| 25276 | fusionAlg_B.ObjList.vision_04_obj.obj_boundary.Y2 = |
| 25277 | fusionAlg_P_g.Constant3_Value_jnv; |
| 25278 | |
| 25279 | /* Lookup_n-D: '<S647>/1-D Lookup Table' */ |
| 25280 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector3.OBJ_Object_Class, |
| 25281 | fusionAlg_P_g.uDLookupTable_bp01Data_l5, 8U); |
| 25282 | fusionAlg_B.Obj_Status_fz = fusionAlg_P_g.uDLookupTable_tableData_a[bpIdx]; |
| 25283 | |
| 25284 | /* DataTypeConversion: '<S647>/Data Type Conversion2' */ |
| 25285 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_fz); |
| 25286 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25287 | tmp = 0.0F; |
| 25288 | } else { |
| 25289 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25290 | } |
| 25291 | |
| 25292 | fusionAlg_B.Obj_Type_f = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25293 | (uint32_T)tmp; |
| 25294 | |
| 25295 | /* End of DataTypeConversion: '<S647>/Data Type Conversion2' */ |
| 25296 | |
| 25297 | /* DataTypeConversion: '<S265>/Data Type Conversion3' */ |
| 25298 | tmp = (real32_T)floor(fusionAlg_B.Selector3.OBJ_Class_Probability); |
| 25299 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25300 | tmp = 0.0F; |
| 25301 | } else { |
| 25302 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25303 | } |
| 25304 | |
| 25305 | fusionAlg_B.Obj_TypeConf_a = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25306 | (uint32_T)tmp; |
| 25307 | |
| 25308 | /* End of DataTypeConversion: '<S265>/Data Type Conversion3' */ |
| 25309 | |
| 25310 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' */ |
| 25311 | fusionAlg_B.ObjList.vision_04_obj.obj_coordinate.lateral = |
| 25312 | fusionAlg_B.Selector3.OBJ_Lat_Distance; |
| 25313 | fusionAlg_B.ObjList.vision_04_obj.obj_coordinate.lateralVariance = |
| 25314 | fusionAlg_B.Selector3.OBJ_Lat_Distance_STD; |
| 25315 | fusionAlg_B.ObjList.vision_04_obj.obj_coordinate.longitudinal = |
| 25316 | fusionAlg_B.Selector3.OBJ_Long_Distance; |
| 25317 | fusionAlg_B.ObjList.vision_04_obj.obj_coordinate.longitudinalVariance = |
| 25318 | fusionAlg_B.Selector3.OBJ_Long_Distance_STD; |
| 25319 | |
| 25320 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' */ |
| 25321 | fusionAlg_B.ObjList.vision_04_obj.obj_velocity.Vx = |
| 25322 | fusionAlg_B.Selector3.OBJ_Abs_Long_Velocity; |
| 25323 | fusionAlg_B.ObjList.vision_04_obj.obj_velocity.VxVariance = |
| 25324 | fusionAlg_B.Selector3.OBJ_Abs_Long_Velocity_STD; |
| 25325 | fusionAlg_B.ObjList.vision_04_obj.obj_velocity.Vy = |
| 25326 | fusionAlg_B.Selector3.OBJ_Abs_Lat_Velocity; |
| 25327 | fusionAlg_B.ObjList.vision_04_obj.obj_velocity.VyVariance = |
| 25328 | fusionAlg_B.Selector3.OBJ_Abs_Lat_Velocity_STD; |
| 25329 | |
| 25330 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' */ |
| 25331 | fusionAlg_B.ObjList.vision_04_obj.obj_angleOfCenter.centerAngle = |
| 25332 | fusionAlg_B.Selector3.OBJ_Angle_Mid; |
| 25333 | fusionAlg_B.ObjList.vision_04_obj.obj_angleOfCenter.centerAngleVariance = |
| 25334 | fusionAlg_B.Selector3.OBJ_Angle_Mid_STD; |
| 25335 | |
| 25336 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' */ |
| 25337 | fusionAlg_B.ObjList.vision_04_obj.obj_acceleration.Ax = |
| 25338 | fusionAlg_B.Selector3.OBJ_Abs_Long_Acc; |
| 25339 | fusionAlg_B.ObjList.vision_04_obj.obj_acceleration.AxVariance = |
| 25340 | fusionAlg_B.Selector3.OBJ_Abs_Long_Acc_STD; |
| 25341 | fusionAlg_B.ObjList.vision_04_obj.obj_acceleration.Ay = |
| 25342 | fusionAlg_B.Selector3.OBJ_Abs_Lat_Acc; |
| 25343 | fusionAlg_B.ObjList.vision_04_obj.obj_acceleration.AyVariance = |
| 25344 | fusionAlg_B.Selector3.OBJ_Abs_Lat_Acc_STD; |
| 25345 | |
| 25346 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' */ |
| 25347 | fusionAlg_B.ObjList.vision_04_obj.AyVariance.length = |
| 25348 | fusionAlg_B.Selector3.OBJ_Length; |
| 25349 | fusionAlg_B.ObjList.vision_04_obj.AyVariance.width = |
| 25350 | fusionAlg_B.Selector3.OBJ_Width; |
| 25351 | fusionAlg_B.ObjList.vision_04_obj.AyVariance.height = |
| 25352 | fusionAlg_B.Selector3.OBJ_Height; |
| 25353 | |
| 25354 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' incorporates: |
| 25355 | * Constant: '<S644>/Constant1' |
| 25356 | * Constant: '<S644>/Constant2' |
| 25357 | * Constant: '<S644>/Constant3' |
| 25358 | */ |
| 25359 | fusionAlg_B.ObjList.vision_04_obj.reserved1.reserved0 = |
| 25360 | fusionAlg_P_g.Constant2_Value_gp; |
| 25361 | fusionAlg_B.ObjList.vision_04_obj.reserved1.reserved1 = |
| 25362 | fusionAlg_P_g.Constant1_Value_mo; |
| 25363 | fusionAlg_B.ObjList.vision_04_obj.reserved1.reserved2 = |
| 25364 | fusionAlg_P_g.Constant3_Value_fek; |
| 25365 | |
| 25366 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' incorporates: |
| 25367 | * Constant: '<S645>/Constant5' |
| 25368 | * Constant: '<S645>/Constant6' |
| 25369 | */ |
| 25370 | fusionAlg_B.ObjList.vision_04_obj.reserved2.reserved0 = |
| 25371 | fusionAlg_P_g.Constant5_Value_hk; |
| 25372 | fusionAlg_B.ObjList.vision_04_obj.reserved2.reserved1 = |
| 25373 | fusionAlg_P_g.Constant6_Value_lql; |
| 25374 | |
| 25375 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_3' incorporates: |
| 25376 | * Constant: '<S265>/Constant' |
| 25377 | * Constant: '<S265>/Constant1' |
| 25378 | * Constant: '<S265>/Constant2' |
| 25379 | * Constant: '<S265>/Constant3' |
| 25380 | * Constant: '<S265>/Constant4' |
| 25381 | */ |
| 25382 | fusionAlg_B.ObjList.vision_04_obj.obj_type = fusionAlg_B.Obj_Type_f; |
| 25383 | fusionAlg_B.ObjList.vision_04_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_a; |
| 25384 | fusionAlg_B.ObjList.vision_04_obj.obj_TTC = fusionAlg_B.Selector3.OBJ_Inv_TTC; |
| 25385 | fusionAlg_B.ObjList.vision_04_obj.obj_TTCVariance = |
| 25386 | fusionAlg_B.Selector3.OBJ_Inv_TTC_STD; |
| 25387 | fusionAlg_B.ObjList.vision_04_obj.obj_existProb = |
| 25388 | fusionAlg_P_g.Constant_Value_o; |
| 25389 | fusionAlg_B.ObjList.vision_04_obj.obj_angleOfObject = |
| 25390 | fusionAlg_P_g.Constant1_Value_fm; |
| 25391 | fusionAlg_B.ObjList.vision_04_obj.obj_Heading = |
| 25392 | fusionAlg_B.Selector3.OBJ_Heading; |
| 25393 | fusionAlg_B.ObjList.vision_04_obj.obj_Heading_STD = |
| 25394 | fusionAlg_P_g.Constant2_Value_ch; |
| 25395 | fusionAlg_B.ObjList.vision_04_obj.obj_Heading_V = |
| 25396 | fusionAlg_P_g.Constant3_Value_owa; |
| 25397 | fusionAlg_B.ObjList.vision_04_obj.obj_Heading_STD_V = |
| 25398 | fusionAlg_P_g.Constant4_Value_fu; |
| 25399 | |
| 25400 | /* Selector: '<S223>/Selector4' incorporates: |
| 25401 | * Constant: '<S223>/Constant4' |
| 25402 | */ |
| 25403 | fusionAlg_B.Selector4 = rtu_EyeQ4_Info_st-> |
| 25404 | OBJ_BUS[fusionAlg_P_g.Constant4_Value_ipn]; |
| 25405 | |
| 25406 | /* DataTypeConversion: '<S267>/Data Type Conversion' */ |
| 25407 | tmp = (real32_T)floor(fusionAlg_B.Selector4.OBJ_ID); |
| 25408 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25409 | tmp = 0.0F; |
| 25410 | } else { |
| 25411 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25412 | } |
| 25413 | |
| 25414 | fusionAlg_B.ObjList.vision_05_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 25415 | (uint32_T)-tmp : (uint32_T)tmp; |
| 25416 | |
| 25417 | /* End of DataTypeConversion: '<S267>/Data Type Conversion' */ |
| 25418 | |
| 25419 | /* Lookup_n-D: '<S668>/1-D Lookup Table' */ |
| 25420 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector4.OBJ_Measuring_Status, |
| 25421 | fusionAlg_P_g.uDLookupTable_bp01Data_m, 7U); |
| 25422 | fusionAlg_B.Obj_Status_c1 = fusionAlg_P_g.uDLookupTable_tableData_g[bpIdx]; |
| 25423 | |
| 25424 | /* DataTypeConversion: '<S668>/Data Type Conversion1' */ |
| 25425 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_c1); |
| 25426 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25427 | tmp = 0.0F; |
| 25428 | } else { |
| 25429 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25430 | } |
| 25431 | |
| 25432 | fusionAlg_B.ObjList.vision_05_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 25433 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 25434 | |
| 25435 | /* End of DataTypeConversion: '<S668>/Data Type Conversion1' */ |
| 25436 | |
| 25437 | /* DataTypeConversion: '<S659>/Data Type Conversion' */ |
| 25438 | tmp = (real32_T)floor(fusionAlg_B.Selector4.OBJ_Object_Age); |
| 25439 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25440 | tmp = 0.0F; |
| 25441 | } else { |
| 25442 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 25443 | } |
| 25444 | |
| 25445 | fusionAlg_B.measureAge_b = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 25446 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 25447 | |
| 25448 | /* End of DataTypeConversion: '<S659>/Data Type Conversion' */ |
| 25449 | |
| 25450 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' incorporates: |
| 25451 | * Constant: '<S659>/Constant' |
| 25452 | * Constant: '<S659>/Constant1' |
| 25453 | */ |
| 25454 | fusionAlg_B.ObjList.vision_05_obj.obj_stageAge.totalAge = |
| 25455 | fusionAlg_B.measureAge_b; |
| 25456 | fusionAlg_B.ObjList.vision_05_obj.obj_stageAge.initAge = |
| 25457 | fusionAlg_P_g.Constant_Value_bs; |
| 25458 | fusionAlg_B.ObjList.vision_05_obj.obj_stageAge.measureAge = |
| 25459 | fusionAlg_B.measureAge_b; |
| 25460 | fusionAlg_B.ObjList.vision_05_obj.obj_stageAge.predictAge = |
| 25461 | fusionAlg_P_g.Constant1_Value_h1; |
| 25462 | |
| 25463 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' incorporates: |
| 25464 | * Constant: '<S660>/Constant' |
| 25465 | * Constant: '<S660>/Constant1' |
| 25466 | * Constant: '<S660>/Constant2' |
| 25467 | * Constant: '<S660>/Constant3' |
| 25468 | */ |
| 25469 | fusionAlg_B.ObjList.vision_05_obj.obj_boundary.X1 = |
| 25470 | fusionAlg_P_g.Constant_Value_fu; |
| 25471 | fusionAlg_B.ObjList.vision_05_obj.obj_boundary.Y1 = |
| 25472 | fusionAlg_P_g.Constant1_Value_m; |
| 25473 | fusionAlg_B.ObjList.vision_05_obj.obj_boundary.X2 = |
| 25474 | fusionAlg_P_g.Constant2_Value_gbp; |
| 25475 | fusionAlg_B.ObjList.vision_05_obj.obj_boundary.Y2 = |
| 25476 | fusionAlg_P_g.Constant3_Value_ba; |
| 25477 | |
| 25478 | /* Lookup_n-D: '<S669>/1-D Lookup Table' */ |
| 25479 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector4.OBJ_Object_Class, |
| 25480 | fusionAlg_P_g.uDLookupTable_bp01Data_f, 8U); |
| 25481 | fusionAlg_B.Obj_Status_ez = fusionAlg_P_g.uDLookupTable_tableData_l[bpIdx]; |
| 25482 | |
| 25483 | /* DataTypeConversion: '<S669>/Data Type Conversion2' */ |
| 25484 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ez); |
| 25485 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25486 | tmp = 0.0F; |
| 25487 | } else { |
| 25488 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25489 | } |
| 25490 | |
| 25491 | fusionAlg_B.Obj_Type_h = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25492 | (uint32_T)tmp; |
| 25493 | |
| 25494 | /* End of DataTypeConversion: '<S669>/Data Type Conversion2' */ |
| 25495 | |
| 25496 | /* DataTypeConversion: '<S267>/Data Type Conversion3' */ |
| 25497 | tmp = (real32_T)floor(fusionAlg_B.Selector4.OBJ_Class_Probability); |
| 25498 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25499 | tmp = 0.0F; |
| 25500 | } else { |
| 25501 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25502 | } |
| 25503 | |
| 25504 | fusionAlg_B.Obj_TypeConf_dn = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25505 | (uint32_T)tmp; |
| 25506 | |
| 25507 | /* End of DataTypeConversion: '<S267>/Data Type Conversion3' */ |
| 25508 | |
| 25509 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' */ |
| 25510 | fusionAlg_B.ObjList.vision_05_obj.obj_coordinate.lateral = |
| 25511 | fusionAlg_B.Selector4.OBJ_Lat_Distance; |
| 25512 | fusionAlg_B.ObjList.vision_05_obj.obj_coordinate.lateralVariance = |
| 25513 | fusionAlg_B.Selector4.OBJ_Lat_Distance_STD; |
| 25514 | fusionAlg_B.ObjList.vision_05_obj.obj_coordinate.longitudinal = |
| 25515 | fusionAlg_B.Selector4.OBJ_Long_Distance; |
| 25516 | fusionAlg_B.ObjList.vision_05_obj.obj_coordinate.longitudinalVariance = |
| 25517 | fusionAlg_B.Selector4.OBJ_Long_Distance_STD; |
| 25518 | |
| 25519 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' */ |
| 25520 | fusionAlg_B.ObjList.vision_05_obj.obj_velocity.Vx = |
| 25521 | fusionAlg_B.Selector4.OBJ_Abs_Long_Velocity; |
| 25522 | fusionAlg_B.ObjList.vision_05_obj.obj_velocity.VxVariance = |
| 25523 | fusionAlg_B.Selector4.OBJ_Abs_Long_Velocity_STD; |
| 25524 | fusionAlg_B.ObjList.vision_05_obj.obj_velocity.Vy = |
| 25525 | fusionAlg_B.Selector4.OBJ_Abs_Lat_Velocity; |
| 25526 | fusionAlg_B.ObjList.vision_05_obj.obj_velocity.VyVariance = |
| 25527 | fusionAlg_B.Selector4.OBJ_Abs_Lat_Velocity_STD; |
| 25528 | |
| 25529 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' */ |
| 25530 | fusionAlg_B.ObjList.vision_05_obj.obj_angleOfCenter.centerAngle = |
| 25531 | fusionAlg_B.Selector4.OBJ_Angle_Mid; |
| 25532 | fusionAlg_B.ObjList.vision_05_obj.obj_angleOfCenter.centerAngleVariance = |
| 25533 | fusionAlg_B.Selector4.OBJ_Angle_Mid_STD; |
| 25534 | |
| 25535 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' */ |
| 25536 | fusionAlg_B.ObjList.vision_05_obj.obj_acceleration.Ax = |
| 25537 | fusionAlg_B.Selector4.OBJ_Abs_Long_Acc; |
| 25538 | fusionAlg_B.ObjList.vision_05_obj.obj_acceleration.AxVariance = |
| 25539 | fusionAlg_B.Selector4.OBJ_Abs_Long_Acc_STD; |
| 25540 | fusionAlg_B.ObjList.vision_05_obj.obj_acceleration.Ay = |
| 25541 | fusionAlg_B.Selector4.OBJ_Abs_Lat_Acc; |
| 25542 | fusionAlg_B.ObjList.vision_05_obj.obj_acceleration.AyVariance = |
| 25543 | fusionAlg_B.Selector4.OBJ_Abs_Lat_Acc_STD; |
| 25544 | |
| 25545 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' */ |
| 25546 | fusionAlg_B.ObjList.vision_05_obj.AyVariance.length = |
| 25547 | fusionAlg_B.Selector4.OBJ_Length; |
| 25548 | fusionAlg_B.ObjList.vision_05_obj.AyVariance.width = |
| 25549 | fusionAlg_B.Selector4.OBJ_Width; |
| 25550 | fusionAlg_B.ObjList.vision_05_obj.AyVariance.height = |
| 25551 | fusionAlg_B.Selector4.OBJ_Height; |
| 25552 | |
| 25553 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' incorporates: |
| 25554 | * Constant: '<S666>/Constant1' |
| 25555 | * Constant: '<S666>/Constant2' |
| 25556 | * Constant: '<S666>/Constant3' |
| 25557 | */ |
| 25558 | fusionAlg_B.ObjList.vision_05_obj.reserved1.reserved0 = |
| 25559 | fusionAlg_P_g.Constant2_Value_fo; |
| 25560 | fusionAlg_B.ObjList.vision_05_obj.reserved1.reserved1 = |
| 25561 | fusionAlg_P_g.Constant1_Value_hq1; |
| 25562 | fusionAlg_B.ObjList.vision_05_obj.reserved1.reserved2 = |
| 25563 | fusionAlg_P_g.Constant3_Value_ek; |
| 25564 | |
| 25565 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' incorporates: |
| 25566 | * Constant: '<S667>/Constant5' |
| 25567 | * Constant: '<S667>/Constant6' |
| 25568 | */ |
| 25569 | fusionAlg_B.ObjList.vision_05_obj.reserved2.reserved0 = |
| 25570 | fusionAlg_P_g.Constant5_Value_dc; |
| 25571 | fusionAlg_B.ObjList.vision_05_obj.reserved2.reserved1 = |
| 25572 | fusionAlg_P_g.Constant6_Value_cso; |
| 25573 | |
| 25574 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_4' incorporates: |
| 25575 | * Constant: '<S267>/Constant' |
| 25576 | * Constant: '<S267>/Constant1' |
| 25577 | * Constant: '<S267>/Constant2' |
| 25578 | * Constant: '<S267>/Constant3' |
| 25579 | * Constant: '<S267>/Constant4' |
| 25580 | */ |
| 25581 | fusionAlg_B.ObjList.vision_05_obj.obj_type = fusionAlg_B.Obj_Type_h; |
| 25582 | fusionAlg_B.ObjList.vision_05_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_dn; |
| 25583 | fusionAlg_B.ObjList.vision_05_obj.obj_TTC = fusionAlg_B.Selector4.OBJ_Inv_TTC; |
| 25584 | fusionAlg_B.ObjList.vision_05_obj.obj_TTCVariance = |
| 25585 | fusionAlg_B.Selector4.OBJ_Inv_TTC_STD; |
| 25586 | fusionAlg_B.ObjList.vision_05_obj.obj_existProb = |
| 25587 | fusionAlg_P_g.Constant_Value_b; |
| 25588 | fusionAlg_B.ObjList.vision_05_obj.obj_angleOfObject = |
| 25589 | fusionAlg_P_g.Constant1_Value_bmk; |
| 25590 | fusionAlg_B.ObjList.vision_05_obj.obj_Heading = |
| 25591 | fusionAlg_B.Selector4.OBJ_Heading; |
| 25592 | fusionAlg_B.ObjList.vision_05_obj.obj_Heading_STD = |
| 25593 | fusionAlg_P_g.Constant2_Value_jh; |
| 25594 | fusionAlg_B.ObjList.vision_05_obj.obj_Heading_V = |
| 25595 | fusionAlg_P_g.Constant3_Value_fe; |
| 25596 | fusionAlg_B.ObjList.vision_05_obj.obj_Heading_STD_V = |
| 25597 | fusionAlg_P_g.Constant4_Value_nv; |
| 25598 | |
| 25599 | /* Selector: '<S223>/Selector5' incorporates: |
| 25600 | * Constant: '<S223>/Constant5' |
| 25601 | */ |
| 25602 | fusionAlg_B.Selector5 = rtu_EyeQ4_Info_st-> |
| 25603 | OBJ_BUS[fusionAlg_P_g.Constant5_Value_hkc]; |
| 25604 | |
| 25605 | /* DataTypeConversion: '<S268>/Data Type Conversion' */ |
| 25606 | tmp = (real32_T)floor(fusionAlg_B.Selector5.OBJ_ID); |
| 25607 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25608 | tmp = 0.0F; |
| 25609 | } else { |
| 25610 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25611 | } |
| 25612 | |
| 25613 | fusionAlg_B.ObjList.vision_06_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 25614 | (uint32_T)-tmp : (uint32_T)tmp; |
| 25615 | |
| 25616 | /* End of DataTypeConversion: '<S268>/Data Type Conversion' */ |
| 25617 | |
| 25618 | /* Lookup_n-D: '<S679>/1-D Lookup Table' */ |
| 25619 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector5.OBJ_Measuring_Status, |
| 25620 | fusionAlg_P_g.uDLookupTable_bp01Data_kx, 7U); |
| 25621 | fusionAlg_B.Obj_Status_b4 = fusionAlg_P_g.uDLookupTable_tableData_d[bpIdx]; |
| 25622 | |
| 25623 | /* DataTypeConversion: '<S679>/Data Type Conversion1' */ |
| 25624 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_b4); |
| 25625 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25626 | tmp = 0.0F; |
| 25627 | } else { |
| 25628 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25629 | } |
| 25630 | |
| 25631 | fusionAlg_B.ObjList.vision_06_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 25632 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 25633 | |
| 25634 | /* End of DataTypeConversion: '<S679>/Data Type Conversion1' */ |
| 25635 | |
| 25636 | /* DataTypeConversion: '<S670>/Data Type Conversion' */ |
| 25637 | tmp = (real32_T)floor(fusionAlg_B.Selector5.OBJ_Object_Age); |
| 25638 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25639 | tmp = 0.0F; |
| 25640 | } else { |
| 25641 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 25642 | } |
| 25643 | |
| 25644 | fusionAlg_B.measureAge_je = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 25645 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 25646 | |
| 25647 | /* End of DataTypeConversion: '<S670>/Data Type Conversion' */ |
| 25648 | |
| 25649 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' incorporates: |
| 25650 | * Constant: '<S670>/Constant' |
| 25651 | * Constant: '<S670>/Constant1' |
| 25652 | */ |
| 25653 | fusionAlg_B.ObjList.vision_06_obj.obj_stageAge.totalAge = |
| 25654 | fusionAlg_B.measureAge_je; |
| 25655 | fusionAlg_B.ObjList.vision_06_obj.obj_stageAge.initAge = |
| 25656 | fusionAlg_P_g.Constant_Value_j4; |
| 25657 | fusionAlg_B.ObjList.vision_06_obj.obj_stageAge.measureAge = |
| 25658 | fusionAlg_B.measureAge_je; |
| 25659 | fusionAlg_B.ObjList.vision_06_obj.obj_stageAge.predictAge = |
| 25660 | fusionAlg_P_g.Constant1_Value_pw; |
| 25661 | |
| 25662 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' incorporates: |
| 25663 | * Constant: '<S671>/Constant' |
| 25664 | * Constant: '<S671>/Constant1' |
| 25665 | * Constant: '<S671>/Constant2' |
| 25666 | * Constant: '<S671>/Constant3' |
| 25667 | */ |
| 25668 | fusionAlg_B.ObjList.vision_06_obj.obj_boundary.X1 = |
| 25669 | fusionAlg_P_g.Constant_Value_ic; |
| 25670 | fusionAlg_B.ObjList.vision_06_obj.obj_boundary.Y1 = |
| 25671 | fusionAlg_P_g.Constant1_Value_f; |
| 25672 | fusionAlg_B.ObjList.vision_06_obj.obj_boundary.X2 = |
| 25673 | fusionAlg_P_g.Constant2_Value_nn; |
| 25674 | fusionAlg_B.ObjList.vision_06_obj.obj_boundary.Y2 = |
| 25675 | fusionAlg_P_g.Constant3_Value_era; |
| 25676 | |
| 25677 | /* Lookup_n-D: '<S680>/1-D Lookup Table' */ |
| 25678 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector5.OBJ_Object_Class, |
| 25679 | fusionAlg_P_g.uDLookupTable_bp01Data_e, 8U); |
| 25680 | fusionAlg_B.Obj_Status_lyp = fusionAlg_P_g.uDLookupTable_tableData_e[bpIdx]; |
| 25681 | |
| 25682 | /* DataTypeConversion: '<S680>/Data Type Conversion2' */ |
| 25683 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_lyp); |
| 25684 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25685 | tmp = 0.0F; |
| 25686 | } else { |
| 25687 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25688 | } |
| 25689 | |
| 25690 | fusionAlg_B.Obj_Type_f2 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25691 | (uint32_T)tmp; |
| 25692 | |
| 25693 | /* End of DataTypeConversion: '<S680>/Data Type Conversion2' */ |
| 25694 | |
| 25695 | /* DataTypeConversion: '<S268>/Data Type Conversion3' */ |
| 25696 | tmp = (real32_T)floor(fusionAlg_B.Selector5.OBJ_Class_Probability); |
| 25697 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25698 | tmp = 0.0F; |
| 25699 | } else { |
| 25700 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25701 | } |
| 25702 | |
| 25703 | fusionAlg_B.Obj_TypeConf_g = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25704 | (uint32_T)tmp; |
| 25705 | |
| 25706 | /* End of DataTypeConversion: '<S268>/Data Type Conversion3' */ |
| 25707 | |
| 25708 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' */ |
| 25709 | fusionAlg_B.ObjList.vision_06_obj.obj_coordinate.lateral = |
| 25710 | fusionAlg_B.Selector5.OBJ_Lat_Distance; |
| 25711 | fusionAlg_B.ObjList.vision_06_obj.obj_coordinate.lateralVariance = |
| 25712 | fusionAlg_B.Selector5.OBJ_Lat_Distance_STD; |
| 25713 | fusionAlg_B.ObjList.vision_06_obj.obj_coordinate.longitudinal = |
| 25714 | fusionAlg_B.Selector5.OBJ_Long_Distance; |
| 25715 | fusionAlg_B.ObjList.vision_06_obj.obj_coordinate.longitudinalVariance = |
| 25716 | fusionAlg_B.Selector5.OBJ_Long_Distance_STD; |
| 25717 | |
| 25718 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' */ |
| 25719 | fusionAlg_B.ObjList.vision_06_obj.obj_velocity.Vx = |
| 25720 | fusionAlg_B.Selector5.OBJ_Abs_Long_Velocity; |
| 25721 | fusionAlg_B.ObjList.vision_06_obj.obj_velocity.VxVariance = |
| 25722 | fusionAlg_B.Selector5.OBJ_Abs_Long_Velocity_STD; |
| 25723 | fusionAlg_B.ObjList.vision_06_obj.obj_velocity.Vy = |
| 25724 | fusionAlg_B.Selector5.OBJ_Abs_Lat_Velocity; |
| 25725 | fusionAlg_B.ObjList.vision_06_obj.obj_velocity.VyVariance = |
| 25726 | fusionAlg_B.Selector5.OBJ_Abs_Lat_Velocity_STD; |
| 25727 | |
| 25728 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' */ |
| 25729 | fusionAlg_B.ObjList.vision_06_obj.obj_angleOfCenter.centerAngle = |
| 25730 | fusionAlg_B.Selector5.OBJ_Angle_Mid; |
| 25731 | fusionAlg_B.ObjList.vision_06_obj.obj_angleOfCenter.centerAngleVariance = |
| 25732 | fusionAlg_B.Selector5.OBJ_Angle_Mid_STD; |
| 25733 | |
| 25734 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' */ |
| 25735 | fusionAlg_B.ObjList.vision_06_obj.obj_acceleration.Ax = |
| 25736 | fusionAlg_B.Selector5.OBJ_Abs_Long_Acc; |
| 25737 | fusionAlg_B.ObjList.vision_06_obj.obj_acceleration.AxVariance = |
| 25738 | fusionAlg_B.Selector5.OBJ_Abs_Long_Acc_STD; |
| 25739 | fusionAlg_B.ObjList.vision_06_obj.obj_acceleration.Ay = |
| 25740 | fusionAlg_B.Selector5.OBJ_Abs_Lat_Acc; |
| 25741 | fusionAlg_B.ObjList.vision_06_obj.obj_acceleration.AyVariance = |
| 25742 | fusionAlg_B.Selector5.OBJ_Abs_Lat_Acc_STD; |
| 25743 | |
| 25744 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' */ |
| 25745 | fusionAlg_B.ObjList.vision_06_obj.AyVariance.length = |
| 25746 | fusionAlg_B.Selector5.OBJ_Length; |
| 25747 | fusionAlg_B.ObjList.vision_06_obj.AyVariance.width = |
| 25748 | fusionAlg_B.Selector5.OBJ_Width; |
| 25749 | fusionAlg_B.ObjList.vision_06_obj.AyVariance.height = |
| 25750 | fusionAlg_B.Selector5.OBJ_Height; |
| 25751 | |
| 25752 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' incorporates: |
| 25753 | * Constant: '<S677>/Constant1' |
| 25754 | * Constant: '<S677>/Constant2' |
| 25755 | * Constant: '<S677>/Constant3' |
| 25756 | */ |
| 25757 | fusionAlg_B.ObjList.vision_06_obj.reserved1.reserved0 = |
| 25758 | fusionAlg_P_g.Constant2_Value_pt; |
| 25759 | fusionAlg_B.ObjList.vision_06_obj.reserved1.reserved1 = |
| 25760 | fusionAlg_P_g.Constant1_Value_hd; |
| 25761 | fusionAlg_B.ObjList.vision_06_obj.reserved1.reserved2 = |
| 25762 | fusionAlg_P_g.Constant3_Value_h3e; |
| 25763 | |
| 25764 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' incorporates: |
| 25765 | * Constant: '<S678>/Constant5' |
| 25766 | * Constant: '<S678>/Constant6' |
| 25767 | */ |
| 25768 | fusionAlg_B.ObjList.vision_06_obj.reserved2.reserved0 = |
| 25769 | fusionAlg_P_g.Constant5_Value_ll; |
| 25770 | fusionAlg_B.ObjList.vision_06_obj.reserved2.reserved1 = |
| 25771 | fusionAlg_P_g.Constant6_Value_hg; |
| 25772 | |
| 25773 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_5' incorporates: |
| 25774 | * Constant: '<S268>/Constant' |
| 25775 | * Constant: '<S268>/Constant1' |
| 25776 | * Constant: '<S268>/Constant2' |
| 25777 | * Constant: '<S268>/Constant3' |
| 25778 | * Constant: '<S268>/Constant4' |
| 25779 | */ |
| 25780 | fusionAlg_B.ObjList.vision_06_obj.obj_type = fusionAlg_B.Obj_Type_f2; |
| 25781 | fusionAlg_B.ObjList.vision_06_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_g; |
| 25782 | fusionAlg_B.ObjList.vision_06_obj.obj_TTC = fusionAlg_B.Selector5.OBJ_Inv_TTC; |
| 25783 | fusionAlg_B.ObjList.vision_06_obj.obj_TTCVariance = |
| 25784 | fusionAlg_B.Selector5.OBJ_Inv_TTC_STD; |
| 25785 | fusionAlg_B.ObjList.vision_06_obj.obj_existProb = |
| 25786 | fusionAlg_P_g.Constant_Value_a; |
| 25787 | fusionAlg_B.ObjList.vision_06_obj.obj_angleOfObject = |
| 25788 | fusionAlg_P_g.Constant1_Value_oj; |
| 25789 | fusionAlg_B.ObjList.vision_06_obj.obj_Heading = |
| 25790 | fusionAlg_B.Selector5.OBJ_Heading; |
| 25791 | fusionAlg_B.ObjList.vision_06_obj.obj_Heading_STD = |
| 25792 | fusionAlg_P_g.Constant2_Value_gr3; |
| 25793 | fusionAlg_B.ObjList.vision_06_obj.obj_Heading_V = |
| 25794 | fusionAlg_P_g.Constant3_Value_bj; |
| 25795 | fusionAlg_B.ObjList.vision_06_obj.obj_Heading_STD_V = |
| 25796 | fusionAlg_P_g.Constant4_Value_jnx; |
| 25797 | |
| 25798 | /* Selector: '<S223>/Selector6' incorporates: |
| 25799 | * Constant: '<S223>/Constant6' |
| 25800 | */ |
| 25801 | fusionAlg_B.Selector6 = rtu_EyeQ4_Info_st-> |
| 25802 | OBJ_BUS[fusionAlg_P_g.Constant6_Value_et]; |
| 25803 | |
| 25804 | /* DataTypeConversion: '<S269>/Data Type Conversion' */ |
| 25805 | tmp = (real32_T)floor(fusionAlg_B.Selector6.OBJ_ID); |
| 25806 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25807 | tmp = 0.0F; |
| 25808 | } else { |
| 25809 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25810 | } |
| 25811 | |
| 25812 | fusionAlg_B.ObjList.vision_07_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 25813 | (uint32_T)-tmp : (uint32_T)tmp; |
| 25814 | |
| 25815 | /* End of DataTypeConversion: '<S269>/Data Type Conversion' */ |
| 25816 | |
| 25817 | /* Lookup_n-D: '<S690>/1-D Lookup Table' */ |
| 25818 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector6.OBJ_Measuring_Status, |
| 25819 | fusionAlg_P_g.uDLookupTable_bp01Data_eg, 7U); |
| 25820 | fusionAlg_B.Obj_Status_f4 = fusionAlg_P_g.uDLookupTable_tableData_k[bpIdx]; |
| 25821 | |
| 25822 | /* DataTypeConversion: '<S690>/Data Type Conversion1' */ |
| 25823 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_f4); |
| 25824 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25825 | tmp = 0.0F; |
| 25826 | } else { |
| 25827 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25828 | } |
| 25829 | |
| 25830 | fusionAlg_B.ObjList.vision_07_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 25831 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 25832 | |
| 25833 | /* End of DataTypeConversion: '<S690>/Data Type Conversion1' */ |
| 25834 | |
| 25835 | /* DataTypeConversion: '<S681>/Data Type Conversion' */ |
| 25836 | tmp = (real32_T)floor(fusionAlg_B.Selector6.OBJ_Object_Age); |
| 25837 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25838 | tmp = 0.0F; |
| 25839 | } else { |
| 25840 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 25841 | } |
| 25842 | |
| 25843 | fusionAlg_B.measureAge_g = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 25844 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 25845 | |
| 25846 | /* End of DataTypeConversion: '<S681>/Data Type Conversion' */ |
| 25847 | |
| 25848 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' incorporates: |
| 25849 | * Constant: '<S681>/Constant' |
| 25850 | * Constant: '<S681>/Constant1' |
| 25851 | */ |
| 25852 | fusionAlg_B.ObjList.vision_07_obj.obj_stageAge.totalAge = |
| 25853 | fusionAlg_B.measureAge_g; |
| 25854 | fusionAlg_B.ObjList.vision_07_obj.obj_stageAge.initAge = |
| 25855 | fusionAlg_P_g.Constant_Value_ad; |
| 25856 | fusionAlg_B.ObjList.vision_07_obj.obj_stageAge.measureAge = |
| 25857 | fusionAlg_B.measureAge_g; |
| 25858 | fusionAlg_B.ObjList.vision_07_obj.obj_stageAge.predictAge = |
| 25859 | fusionAlg_P_g.Constant1_Value_gn; |
| 25860 | |
| 25861 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' incorporates: |
| 25862 | * Constant: '<S682>/Constant' |
| 25863 | * Constant: '<S682>/Constant1' |
| 25864 | * Constant: '<S682>/Constant2' |
| 25865 | * Constant: '<S682>/Constant3' |
| 25866 | */ |
| 25867 | fusionAlg_B.ObjList.vision_07_obj.obj_boundary.X1 = |
| 25868 | fusionAlg_P_g.Constant_Value_k; |
| 25869 | fusionAlg_B.ObjList.vision_07_obj.obj_boundary.Y1 = |
| 25870 | fusionAlg_P_g.Constant1_Value_g; |
| 25871 | fusionAlg_B.ObjList.vision_07_obj.obj_boundary.X2 = |
| 25872 | fusionAlg_P_g.Constant2_Value_am; |
| 25873 | fusionAlg_B.ObjList.vision_07_obj.obj_boundary.Y2 = |
| 25874 | fusionAlg_P_g.Constant3_Value_nlq; |
| 25875 | |
| 25876 | /* Lookup_n-D: '<S691>/1-D Lookup Table' */ |
| 25877 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector6.OBJ_Object_Class, |
| 25878 | fusionAlg_P_g.uDLookupTable_bp01Data_i, 8U); |
| 25879 | fusionAlg_B.Obj_Status_bo = fusionAlg_P_g.uDLookupTable_tableData_lc[bpIdx]; |
| 25880 | |
| 25881 | /* DataTypeConversion: '<S691>/Data Type Conversion2' */ |
| 25882 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_bo); |
| 25883 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25884 | tmp = 0.0F; |
| 25885 | } else { |
| 25886 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25887 | } |
| 25888 | |
| 25889 | fusionAlg_B.Obj_Type_i = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25890 | (uint32_T)tmp; |
| 25891 | |
| 25892 | /* End of DataTypeConversion: '<S691>/Data Type Conversion2' */ |
| 25893 | |
| 25894 | /* DataTypeConversion: '<S269>/Data Type Conversion3' */ |
| 25895 | tmp = (real32_T)floor(fusionAlg_B.Selector6.OBJ_Class_Probability); |
| 25896 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 25897 | tmp = 0.0F; |
| 25898 | } else { |
| 25899 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 25900 | } |
| 25901 | |
| 25902 | fusionAlg_B.Obj_TypeConf_c = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 25903 | (uint32_T)tmp; |
| 25904 | |
| 25905 | /* End of DataTypeConversion: '<S269>/Data Type Conversion3' */ |
| 25906 | |
| 25907 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' */ |
| 25908 | fusionAlg_B.ObjList.vision_07_obj.obj_coordinate.lateral = |
| 25909 | fusionAlg_B.Selector6.OBJ_Lat_Distance; |
| 25910 | fusionAlg_B.ObjList.vision_07_obj.obj_coordinate.lateralVariance = |
| 25911 | fusionAlg_B.Selector6.OBJ_Lat_Distance_STD; |
| 25912 | fusionAlg_B.ObjList.vision_07_obj.obj_coordinate.longitudinal = |
| 25913 | fusionAlg_B.Selector6.OBJ_Long_Distance; |
| 25914 | fusionAlg_B.ObjList.vision_07_obj.obj_coordinate.longitudinalVariance = |
| 25915 | fusionAlg_B.Selector6.OBJ_Long_Distance_STD; |
| 25916 | |
| 25917 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' */ |
| 25918 | fusionAlg_B.ObjList.vision_07_obj.obj_velocity.Vx = |
| 25919 | fusionAlg_B.Selector6.OBJ_Abs_Long_Velocity; |
| 25920 | fusionAlg_B.ObjList.vision_07_obj.obj_velocity.VxVariance = |
| 25921 | fusionAlg_B.Selector6.OBJ_Abs_Long_Velocity_STD; |
| 25922 | fusionAlg_B.ObjList.vision_07_obj.obj_velocity.Vy = |
| 25923 | fusionAlg_B.Selector6.OBJ_Abs_Lat_Velocity; |
| 25924 | fusionAlg_B.ObjList.vision_07_obj.obj_velocity.VyVariance = |
| 25925 | fusionAlg_B.Selector6.OBJ_Abs_Lat_Velocity_STD; |
| 25926 | |
| 25927 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' */ |
| 25928 | fusionAlg_B.ObjList.vision_07_obj.obj_angleOfCenter.centerAngle = |
| 25929 | fusionAlg_B.Selector6.OBJ_Angle_Mid; |
| 25930 | fusionAlg_B.ObjList.vision_07_obj.obj_angleOfCenter.centerAngleVariance = |
| 25931 | fusionAlg_B.Selector6.OBJ_Angle_Mid_STD; |
| 25932 | |
| 25933 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' */ |
| 25934 | fusionAlg_B.ObjList.vision_07_obj.obj_acceleration.Ax = |
| 25935 | fusionAlg_B.Selector6.OBJ_Abs_Long_Acc; |
| 25936 | fusionAlg_B.ObjList.vision_07_obj.obj_acceleration.AxVariance = |
| 25937 | fusionAlg_B.Selector6.OBJ_Abs_Long_Acc_STD; |
| 25938 | fusionAlg_B.ObjList.vision_07_obj.obj_acceleration.Ay = |
| 25939 | fusionAlg_B.Selector6.OBJ_Abs_Lat_Acc; |
| 25940 | fusionAlg_B.ObjList.vision_07_obj.obj_acceleration.AyVariance = |
| 25941 | fusionAlg_B.Selector6.OBJ_Abs_Lat_Acc_STD; |
| 25942 | |
| 25943 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' */ |
| 25944 | fusionAlg_B.ObjList.vision_07_obj.AyVariance.length = |
| 25945 | fusionAlg_B.Selector6.OBJ_Length; |
| 25946 | fusionAlg_B.ObjList.vision_07_obj.AyVariance.width = |
| 25947 | fusionAlg_B.Selector6.OBJ_Width; |
| 25948 | fusionAlg_B.ObjList.vision_07_obj.AyVariance.height = |
| 25949 | fusionAlg_B.Selector6.OBJ_Height; |
| 25950 | |
| 25951 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' incorporates: |
| 25952 | * Constant: '<S688>/Constant1' |
| 25953 | * Constant: '<S688>/Constant2' |
| 25954 | * Constant: '<S688>/Constant3' |
| 25955 | */ |
| 25956 | fusionAlg_B.ObjList.vision_07_obj.reserved1.reserved0 = |
| 25957 | fusionAlg_P_g.Constant2_Value_dcn; |
| 25958 | fusionAlg_B.ObjList.vision_07_obj.reserved1.reserved1 = |
| 25959 | fusionAlg_P_g.Constant1_Value_jjt; |
| 25960 | fusionAlg_B.ObjList.vision_07_obj.reserved1.reserved2 = |
| 25961 | fusionAlg_P_g.Constant3_Value_ld; |
| 25962 | |
| 25963 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' incorporates: |
| 25964 | * Constant: '<S689>/Constant5' |
| 25965 | * Constant: '<S689>/Constant6' |
| 25966 | */ |
| 25967 | fusionAlg_B.ObjList.vision_07_obj.reserved2.reserved0 = |
| 25968 | fusionAlg_P_g.Constant5_Value_fpg; |
| 25969 | fusionAlg_B.ObjList.vision_07_obj.reserved2.reserved1 = |
| 25970 | fusionAlg_P_g.Constant6_Value_ky; |
| 25971 | |
| 25972 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_6' incorporates: |
| 25973 | * Constant: '<S269>/Constant' |
| 25974 | * Constant: '<S269>/Constant1' |
| 25975 | * Constant: '<S269>/Constant2' |
| 25976 | * Constant: '<S269>/Constant3' |
| 25977 | * Constant: '<S269>/Constant4' |
| 25978 | */ |
| 25979 | fusionAlg_B.ObjList.vision_07_obj.obj_type = fusionAlg_B.Obj_Type_i; |
| 25980 | fusionAlg_B.ObjList.vision_07_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_c; |
| 25981 | fusionAlg_B.ObjList.vision_07_obj.obj_TTC = fusionAlg_B.Selector6.OBJ_Inv_TTC; |
| 25982 | fusionAlg_B.ObjList.vision_07_obj.obj_TTCVariance = |
| 25983 | fusionAlg_B.Selector6.OBJ_Inv_TTC_STD; |
| 25984 | fusionAlg_B.ObjList.vision_07_obj.obj_existProb = |
| 25985 | fusionAlg_P_g.Constant_Value_a1; |
| 25986 | fusionAlg_B.ObjList.vision_07_obj.obj_angleOfObject = |
| 25987 | fusionAlg_P_g.Constant1_Value_c1; |
| 25988 | fusionAlg_B.ObjList.vision_07_obj.obj_Heading = |
| 25989 | fusionAlg_B.Selector6.OBJ_Heading; |
| 25990 | fusionAlg_B.ObjList.vision_07_obj.obj_Heading_STD = |
| 25991 | fusionAlg_P_g.Constant2_Value_hsf; |
| 25992 | fusionAlg_B.ObjList.vision_07_obj.obj_Heading_V = |
| 25993 | fusionAlg_P_g.Constant3_Value_jed; |
| 25994 | fusionAlg_B.ObjList.vision_07_obj.obj_Heading_STD_V = |
| 25995 | fusionAlg_P_g.Constant4_Value_pdg; |
| 25996 | |
| 25997 | /* Selector: '<S223>/Selector7' incorporates: |
| 25998 | * Constant: '<S223>/Constant7' |
| 25999 | */ |
| 26000 | fusionAlg_B.Selector7 = rtu_EyeQ4_Info_st-> |
| 26001 | OBJ_BUS[fusionAlg_P_g.Constant7_Value_eh]; |
| 26002 | |
| 26003 | /* DataTypeConversion: '<S270>/Data Type Conversion' */ |
| 26004 | tmp = (real32_T)floor(fusionAlg_B.Selector7.OBJ_ID); |
| 26005 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26006 | tmp = 0.0F; |
| 26007 | } else { |
| 26008 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26009 | } |
| 26010 | |
| 26011 | fusionAlg_B.ObjList.vision_08_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 26012 | (uint32_T)-tmp : (uint32_T)tmp; |
| 26013 | |
| 26014 | /* End of DataTypeConversion: '<S270>/Data Type Conversion' */ |
| 26015 | |
| 26016 | /* Lookup_n-D: '<S701>/1-D Lookup Table' */ |
| 26017 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector7.OBJ_Measuring_Status, |
| 26018 | fusionAlg_P_g.uDLookupTable_bp01Data_p, 7U); |
| 26019 | fusionAlg_B.Obj_Status_g = fusionAlg_P_g.uDLookupTable_tableData_lca[bpIdx]; |
| 26020 | |
| 26021 | /* DataTypeConversion: '<S701>/Data Type Conversion1' */ |
| 26022 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_g); |
| 26023 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26024 | tmp = 0.0F; |
| 26025 | } else { |
| 26026 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26027 | } |
| 26028 | |
| 26029 | fusionAlg_B.ObjList.vision_08_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 26030 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 26031 | |
| 26032 | /* End of DataTypeConversion: '<S701>/Data Type Conversion1' */ |
| 26033 | |
| 26034 | /* DataTypeConversion: '<S692>/Data Type Conversion' */ |
| 26035 | tmp = (real32_T)floor(fusionAlg_B.Selector7.OBJ_Object_Age); |
| 26036 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26037 | tmp = 0.0F; |
| 26038 | } else { |
| 26039 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 26040 | } |
| 26041 | |
| 26042 | fusionAlg_B.measureAge_m = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 26043 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 26044 | |
| 26045 | /* End of DataTypeConversion: '<S692>/Data Type Conversion' */ |
| 26046 | |
| 26047 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' incorporates: |
| 26048 | * Constant: '<S692>/Constant' |
| 26049 | * Constant: '<S692>/Constant1' |
| 26050 | */ |
| 26051 | fusionAlg_B.ObjList.vision_08_obj.obj_stageAge.totalAge = |
| 26052 | fusionAlg_B.measureAge_m; |
| 26053 | fusionAlg_B.ObjList.vision_08_obj.obj_stageAge.initAge = |
| 26054 | fusionAlg_P_g.Constant_Value_i4; |
| 26055 | fusionAlg_B.ObjList.vision_08_obj.obj_stageAge.measureAge = |
| 26056 | fusionAlg_B.measureAge_m; |
| 26057 | fusionAlg_B.ObjList.vision_08_obj.obj_stageAge.predictAge = |
| 26058 | fusionAlg_P_g.Constant1_Value_hl; |
| 26059 | |
| 26060 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' incorporates: |
| 26061 | * Constant: '<S693>/Constant' |
| 26062 | * Constant: '<S693>/Constant1' |
| 26063 | * Constant: '<S693>/Constant2' |
| 26064 | * Constant: '<S693>/Constant3' |
| 26065 | */ |
| 26066 | fusionAlg_B.ObjList.vision_08_obj.obj_boundary.X1 = |
| 26067 | fusionAlg_P_g.Constant_Value_lr; |
| 26068 | fusionAlg_B.ObjList.vision_08_obj.obj_boundary.Y1 = |
| 26069 | fusionAlg_P_g.Constant1_Value_nn; |
| 26070 | fusionAlg_B.ObjList.vision_08_obj.obj_boundary.X2 = |
| 26071 | fusionAlg_P_g.Constant2_Value_pw; |
| 26072 | fusionAlg_B.ObjList.vision_08_obj.obj_boundary.Y2 = |
| 26073 | fusionAlg_P_g.Constant3_Value_lu; |
| 26074 | |
| 26075 | /* Lookup_n-D: '<S702>/1-D Lookup Table' */ |
| 26076 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector7.OBJ_Object_Class, |
| 26077 | fusionAlg_P_g.uDLookupTable_bp01Data_h, 8U); |
| 26078 | fusionAlg_B.Obj_Status_bq = fusionAlg_P_g.uDLookupTable_tableData_f[bpIdx]; |
| 26079 | |
| 26080 | /* DataTypeConversion: '<S702>/Data Type Conversion2' */ |
| 26081 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_bq); |
| 26082 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26083 | tmp = 0.0F; |
| 26084 | } else { |
| 26085 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26086 | } |
| 26087 | |
| 26088 | fusionAlg_B.Obj_Type_e = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26089 | (uint32_T)tmp; |
| 26090 | |
| 26091 | /* End of DataTypeConversion: '<S702>/Data Type Conversion2' */ |
| 26092 | |
| 26093 | /* DataTypeConversion: '<S270>/Data Type Conversion3' */ |
| 26094 | tmp = (real32_T)floor(fusionAlg_B.Selector7.OBJ_Class_Probability); |
| 26095 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26096 | tmp = 0.0F; |
| 26097 | } else { |
| 26098 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26099 | } |
| 26100 | |
| 26101 | fusionAlg_B.Obj_TypeConf_df = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26102 | (uint32_T)tmp; |
| 26103 | |
| 26104 | /* End of DataTypeConversion: '<S270>/Data Type Conversion3' */ |
| 26105 | |
| 26106 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' */ |
| 26107 | fusionAlg_B.ObjList.vision_08_obj.obj_coordinate.lateral = |
| 26108 | fusionAlg_B.Selector7.OBJ_Lat_Distance; |
| 26109 | fusionAlg_B.ObjList.vision_08_obj.obj_coordinate.lateralVariance = |
| 26110 | fusionAlg_B.Selector7.OBJ_Lat_Distance_STD; |
| 26111 | fusionAlg_B.ObjList.vision_08_obj.obj_coordinate.longitudinal = |
| 26112 | fusionAlg_B.Selector7.OBJ_Long_Distance; |
| 26113 | fusionAlg_B.ObjList.vision_08_obj.obj_coordinate.longitudinalVariance = |
| 26114 | fusionAlg_B.Selector7.OBJ_Long_Distance_STD; |
| 26115 | |
| 26116 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' */ |
| 26117 | fusionAlg_B.ObjList.vision_08_obj.obj_velocity.Vx = |
| 26118 | fusionAlg_B.Selector7.OBJ_Abs_Long_Velocity; |
| 26119 | fusionAlg_B.ObjList.vision_08_obj.obj_velocity.VxVariance = |
| 26120 | fusionAlg_B.Selector7.OBJ_Abs_Long_Velocity_STD; |
| 26121 | fusionAlg_B.ObjList.vision_08_obj.obj_velocity.Vy = |
| 26122 | fusionAlg_B.Selector7.OBJ_Abs_Lat_Velocity; |
| 26123 | fusionAlg_B.ObjList.vision_08_obj.obj_velocity.VyVariance = |
| 26124 | fusionAlg_B.Selector7.OBJ_Abs_Lat_Velocity_STD; |
| 26125 | |
| 26126 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' */ |
| 26127 | fusionAlg_B.ObjList.vision_08_obj.obj_angleOfCenter.centerAngle = |
| 26128 | fusionAlg_B.Selector7.OBJ_Angle_Mid; |
| 26129 | fusionAlg_B.ObjList.vision_08_obj.obj_angleOfCenter.centerAngleVariance = |
| 26130 | fusionAlg_B.Selector7.OBJ_Angle_Mid_STD; |
| 26131 | |
| 26132 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' */ |
| 26133 | fusionAlg_B.ObjList.vision_08_obj.obj_acceleration.Ax = |
| 26134 | fusionAlg_B.Selector7.OBJ_Abs_Long_Acc; |
| 26135 | fusionAlg_B.ObjList.vision_08_obj.obj_acceleration.AxVariance = |
| 26136 | fusionAlg_B.Selector7.OBJ_Abs_Long_Acc_STD; |
| 26137 | fusionAlg_B.ObjList.vision_08_obj.obj_acceleration.Ay = |
| 26138 | fusionAlg_B.Selector7.OBJ_Abs_Lat_Acc; |
| 26139 | fusionAlg_B.ObjList.vision_08_obj.obj_acceleration.AyVariance = |
| 26140 | fusionAlg_B.Selector7.OBJ_Abs_Lat_Acc_STD; |
| 26141 | |
| 26142 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' */ |
| 26143 | fusionAlg_B.ObjList.vision_08_obj.AyVariance.length = |
| 26144 | fusionAlg_B.Selector7.OBJ_Length; |
| 26145 | fusionAlg_B.ObjList.vision_08_obj.AyVariance.width = |
| 26146 | fusionAlg_B.Selector7.OBJ_Width; |
| 26147 | fusionAlg_B.ObjList.vision_08_obj.AyVariance.height = |
| 26148 | fusionAlg_B.Selector7.OBJ_Height; |
| 26149 | |
| 26150 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' incorporates: |
| 26151 | * Constant: '<S699>/Constant1' |
| 26152 | * Constant: '<S699>/Constant2' |
| 26153 | * Constant: '<S699>/Constant3' |
| 26154 | */ |
| 26155 | fusionAlg_B.ObjList.vision_08_obj.reserved1.reserved0 = |
| 26156 | fusionAlg_P_g.Constant2_Value_gek; |
| 26157 | fusionAlg_B.ObjList.vision_08_obj.reserved1.reserved1 = |
| 26158 | fusionAlg_P_g.Constant1_Value_dr; |
| 26159 | fusionAlg_B.ObjList.vision_08_obj.reserved1.reserved2 = |
| 26160 | fusionAlg_P_g.Constant3_Value_nw1; |
| 26161 | |
| 26162 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' incorporates: |
| 26163 | * Constant: '<S700>/Constant5' |
| 26164 | * Constant: '<S700>/Constant6' |
| 26165 | */ |
| 26166 | fusionAlg_B.ObjList.vision_08_obj.reserved2.reserved0 = |
| 26167 | fusionAlg_P_g.Constant5_Value_ay; |
| 26168 | fusionAlg_B.ObjList.vision_08_obj.reserved2.reserved1 = |
| 26169 | fusionAlg_P_g.Constant6_Value_cpw; |
| 26170 | |
| 26171 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_7' incorporates: |
| 26172 | * Constant: '<S270>/Constant' |
| 26173 | * Constant: '<S270>/Constant1' |
| 26174 | * Constant: '<S270>/Constant2' |
| 26175 | * Constant: '<S270>/Constant3' |
| 26176 | * Constant: '<S270>/Constant4' |
| 26177 | */ |
| 26178 | fusionAlg_B.ObjList.vision_08_obj.obj_type = fusionAlg_B.Obj_Type_e; |
| 26179 | fusionAlg_B.ObjList.vision_08_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_df; |
| 26180 | fusionAlg_B.ObjList.vision_08_obj.obj_TTC = fusionAlg_B.Selector7.OBJ_Inv_TTC; |
| 26181 | fusionAlg_B.ObjList.vision_08_obj.obj_TTCVariance = |
| 26182 | fusionAlg_B.Selector7.OBJ_Inv_TTC_STD; |
| 26183 | fusionAlg_B.ObjList.vision_08_obj.obj_existProb = |
| 26184 | fusionAlg_P_g.Constant_Value_g; |
| 26185 | fusionAlg_B.ObjList.vision_08_obj.obj_angleOfObject = |
| 26186 | fusionAlg_P_g.Constant1_Value_b4; |
| 26187 | fusionAlg_B.ObjList.vision_08_obj.obj_Heading = |
| 26188 | fusionAlg_B.Selector7.OBJ_Heading; |
| 26189 | fusionAlg_B.ObjList.vision_08_obj.obj_Heading_STD = |
| 26190 | fusionAlg_P_g.Constant2_Value_es1; |
| 26191 | fusionAlg_B.ObjList.vision_08_obj.obj_Heading_V = |
| 26192 | fusionAlg_P_g.Constant3_Value_og; |
| 26193 | fusionAlg_B.ObjList.vision_08_obj.obj_Heading_STD_V = |
| 26194 | fusionAlg_P_g.Constant4_Value_gq3; |
| 26195 | |
| 26196 | /* Selector: '<S223>/Selector8' incorporates: |
| 26197 | * Constant: '<S223>/Constant8' |
| 26198 | */ |
| 26199 | fusionAlg_B.Selector8 = rtu_EyeQ4_Info_st-> |
| 26200 | OBJ_BUS[fusionAlg_P_g.Constant8_Value_gqj]; |
| 26201 | |
| 26202 | /* DataTypeConversion: '<S271>/Data Type Conversion' */ |
| 26203 | tmp = (real32_T)floor(fusionAlg_B.Selector8.OBJ_ID); |
| 26204 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26205 | tmp = 0.0F; |
| 26206 | } else { |
| 26207 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26208 | } |
| 26209 | |
| 26210 | fusionAlg_B.ObjList.vision_09_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 26211 | (uint32_T)-tmp : (uint32_T)tmp; |
| 26212 | |
| 26213 | /* End of DataTypeConversion: '<S271>/Data Type Conversion' */ |
| 26214 | |
| 26215 | /* Lookup_n-D: '<S712>/1-D Lookup Table' */ |
| 26216 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector8.OBJ_Measuring_Status, |
| 26217 | fusionAlg_P_g.uDLookupTable_bp01Data_e5, 7U); |
| 26218 | fusionAlg_B.Obj_Status_fb = fusionAlg_P_g.uDLookupTable_tableData_b[bpIdx]; |
| 26219 | |
| 26220 | /* DataTypeConversion: '<S712>/Data Type Conversion1' */ |
| 26221 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_fb); |
| 26222 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26223 | tmp = 0.0F; |
| 26224 | } else { |
| 26225 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26226 | } |
| 26227 | |
| 26228 | fusionAlg_B.ObjList.vision_09_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 26229 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 26230 | |
| 26231 | /* End of DataTypeConversion: '<S712>/Data Type Conversion1' */ |
| 26232 | |
| 26233 | /* DataTypeConversion: '<S703>/Data Type Conversion' */ |
| 26234 | tmp = (real32_T)floor(fusionAlg_B.Selector8.OBJ_Object_Age); |
| 26235 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26236 | tmp = 0.0F; |
| 26237 | } else { |
| 26238 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 26239 | } |
| 26240 | |
| 26241 | fusionAlg_B.measureAge_c = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 26242 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 26243 | |
| 26244 | /* End of DataTypeConversion: '<S703>/Data Type Conversion' */ |
| 26245 | |
| 26246 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' incorporates: |
| 26247 | * Constant: '<S703>/Constant' |
| 26248 | * Constant: '<S703>/Constant1' |
| 26249 | */ |
| 26250 | fusionAlg_B.ObjList.vision_09_obj.obj_stageAge.totalAge = |
| 26251 | fusionAlg_B.measureAge_c; |
| 26252 | fusionAlg_B.ObjList.vision_09_obj.obj_stageAge.initAge = |
| 26253 | fusionAlg_P_g.Constant_Value_ko; |
| 26254 | fusionAlg_B.ObjList.vision_09_obj.obj_stageAge.measureAge = |
| 26255 | fusionAlg_B.measureAge_c; |
| 26256 | fusionAlg_B.ObjList.vision_09_obj.obj_stageAge.predictAge = |
| 26257 | fusionAlg_P_g.Constant1_Value_i1; |
| 26258 | |
| 26259 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' incorporates: |
| 26260 | * Constant: '<S704>/Constant' |
| 26261 | * Constant: '<S704>/Constant1' |
| 26262 | * Constant: '<S704>/Constant2' |
| 26263 | * Constant: '<S704>/Constant3' |
| 26264 | */ |
| 26265 | fusionAlg_B.ObjList.vision_09_obj.obj_boundary.X1 = |
| 26266 | fusionAlg_P_g.Constant_Value_fe; |
| 26267 | fusionAlg_B.ObjList.vision_09_obj.obj_boundary.Y1 = |
| 26268 | fusionAlg_P_g.Constant1_Value_l; |
| 26269 | fusionAlg_B.ObjList.vision_09_obj.obj_boundary.X2 = |
| 26270 | fusionAlg_P_g.Constant2_Value_buj; |
| 26271 | fusionAlg_B.ObjList.vision_09_obj.obj_boundary.Y2 = |
| 26272 | fusionAlg_P_g.Constant3_Value_cjr; |
| 26273 | |
| 26274 | /* Lookup_n-D: '<S713>/1-D Lookup Table' */ |
| 26275 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector8.OBJ_Object_Class, |
| 26276 | fusionAlg_P_g.uDLookupTable_bp01Data_lx, 8U); |
| 26277 | fusionAlg_B.Obj_Status_cc = fusionAlg_P_g.uDLookupTable_tableData_mh[bpIdx]; |
| 26278 | |
| 26279 | /* DataTypeConversion: '<S713>/Data Type Conversion2' */ |
| 26280 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_cc); |
| 26281 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26282 | tmp = 0.0F; |
| 26283 | } else { |
| 26284 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26285 | } |
| 26286 | |
| 26287 | fusionAlg_B.Obj_Type_b = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26288 | (uint32_T)tmp; |
| 26289 | |
| 26290 | /* End of DataTypeConversion: '<S713>/Data Type Conversion2' */ |
| 26291 | |
| 26292 | /* DataTypeConversion: '<S271>/Data Type Conversion3' */ |
| 26293 | tmp = (real32_T)floor(fusionAlg_B.Selector8.OBJ_Class_Probability); |
| 26294 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26295 | tmp = 0.0F; |
| 26296 | } else { |
| 26297 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26298 | } |
| 26299 | |
| 26300 | fusionAlg_B.Obj_TypeConf_cw = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26301 | (uint32_T)tmp; |
| 26302 | |
| 26303 | /* End of DataTypeConversion: '<S271>/Data Type Conversion3' */ |
| 26304 | |
| 26305 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' */ |
| 26306 | fusionAlg_B.ObjList.vision_09_obj.obj_coordinate.lateral = |
| 26307 | fusionAlg_B.Selector8.OBJ_Lat_Distance; |
| 26308 | fusionAlg_B.ObjList.vision_09_obj.obj_coordinate.lateralVariance = |
| 26309 | fusionAlg_B.Selector8.OBJ_Lat_Distance_STD; |
| 26310 | fusionAlg_B.ObjList.vision_09_obj.obj_coordinate.longitudinal = |
| 26311 | fusionAlg_B.Selector8.OBJ_Long_Distance; |
| 26312 | fusionAlg_B.ObjList.vision_09_obj.obj_coordinate.longitudinalVariance = |
| 26313 | fusionAlg_B.Selector8.OBJ_Long_Distance_STD; |
| 26314 | |
| 26315 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' */ |
| 26316 | fusionAlg_B.ObjList.vision_09_obj.obj_velocity.Vx = |
| 26317 | fusionAlg_B.Selector8.OBJ_Abs_Long_Velocity; |
| 26318 | fusionAlg_B.ObjList.vision_09_obj.obj_velocity.VxVariance = |
| 26319 | fusionAlg_B.Selector8.OBJ_Abs_Long_Velocity_STD; |
| 26320 | fusionAlg_B.ObjList.vision_09_obj.obj_velocity.Vy = |
| 26321 | fusionAlg_B.Selector8.OBJ_Abs_Lat_Velocity; |
| 26322 | fusionAlg_B.ObjList.vision_09_obj.obj_velocity.VyVariance = |
| 26323 | fusionAlg_B.Selector8.OBJ_Abs_Lat_Velocity_STD; |
| 26324 | |
| 26325 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' */ |
| 26326 | fusionAlg_B.ObjList.vision_09_obj.obj_angleOfCenter.centerAngle = |
| 26327 | fusionAlg_B.Selector8.OBJ_Angle_Mid; |
| 26328 | fusionAlg_B.ObjList.vision_09_obj.obj_angleOfCenter.centerAngleVariance = |
| 26329 | fusionAlg_B.Selector8.OBJ_Angle_Mid_STD; |
| 26330 | |
| 26331 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' */ |
| 26332 | fusionAlg_B.ObjList.vision_09_obj.obj_acceleration.Ax = |
| 26333 | fusionAlg_B.Selector8.OBJ_Abs_Long_Acc; |
| 26334 | fusionAlg_B.ObjList.vision_09_obj.obj_acceleration.AxVariance = |
| 26335 | fusionAlg_B.Selector8.OBJ_Abs_Long_Acc_STD; |
| 26336 | fusionAlg_B.ObjList.vision_09_obj.obj_acceleration.Ay = |
| 26337 | fusionAlg_B.Selector8.OBJ_Abs_Lat_Acc; |
| 26338 | fusionAlg_B.ObjList.vision_09_obj.obj_acceleration.AyVariance = |
| 26339 | fusionAlg_B.Selector8.OBJ_Abs_Lat_Acc_STD; |
| 26340 | |
| 26341 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' */ |
| 26342 | fusionAlg_B.ObjList.vision_09_obj.AyVariance.length = |
| 26343 | fusionAlg_B.Selector8.OBJ_Length; |
| 26344 | fusionAlg_B.ObjList.vision_09_obj.AyVariance.width = |
| 26345 | fusionAlg_B.Selector8.OBJ_Width; |
| 26346 | fusionAlg_B.ObjList.vision_09_obj.AyVariance.height = |
| 26347 | fusionAlg_B.Selector8.OBJ_Height; |
| 26348 | |
| 26349 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' incorporates: |
| 26350 | * Constant: '<S710>/Constant1' |
| 26351 | * Constant: '<S710>/Constant2' |
| 26352 | * Constant: '<S710>/Constant3' |
| 26353 | */ |
| 26354 | fusionAlg_B.ObjList.vision_09_obj.reserved1.reserved0 = |
| 26355 | fusionAlg_P_g.Constant2_Value_hwl; |
| 26356 | fusionAlg_B.ObjList.vision_09_obj.reserved1.reserved1 = |
| 26357 | fusionAlg_P_g.Constant1_Value_d10; |
| 26358 | fusionAlg_B.ObjList.vision_09_obj.reserved1.reserved2 = |
| 26359 | fusionAlg_P_g.Constant3_Value_du; |
| 26360 | |
| 26361 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' incorporates: |
| 26362 | * Constant: '<S711>/Constant5' |
| 26363 | * Constant: '<S711>/Constant6' |
| 26364 | */ |
| 26365 | fusionAlg_B.ObjList.vision_09_obj.reserved2.reserved0 = |
| 26366 | fusionAlg_P_g.Constant5_Value_f3; |
| 26367 | fusionAlg_B.ObjList.vision_09_obj.reserved2.reserved1 = |
| 26368 | fusionAlg_P_g.Constant6_Value_mm; |
| 26369 | |
| 26370 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_8' incorporates: |
| 26371 | * Constant: '<S271>/Constant' |
| 26372 | * Constant: '<S271>/Constant1' |
| 26373 | * Constant: '<S271>/Constant2' |
| 26374 | * Constant: '<S271>/Constant3' |
| 26375 | * Constant: '<S271>/Constant4' |
| 26376 | */ |
| 26377 | fusionAlg_B.ObjList.vision_09_obj.obj_type = fusionAlg_B.Obj_Type_b; |
| 26378 | fusionAlg_B.ObjList.vision_09_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_cw; |
| 26379 | fusionAlg_B.ObjList.vision_09_obj.obj_TTC = fusionAlg_B.Selector8.OBJ_Inv_TTC; |
| 26380 | fusionAlg_B.ObjList.vision_09_obj.obj_TTCVariance = |
| 26381 | fusionAlg_B.Selector8.OBJ_Inv_TTC_STD; |
| 26382 | fusionAlg_B.ObjList.vision_09_obj.obj_existProb = |
| 26383 | fusionAlg_P_g.Constant_Value_f; |
| 26384 | fusionAlg_B.ObjList.vision_09_obj.obj_angleOfObject = |
| 26385 | fusionAlg_P_g.Constant1_Value_p0; |
| 26386 | fusionAlg_B.ObjList.vision_09_obj.obj_Heading = |
| 26387 | fusionAlg_B.Selector8.OBJ_Heading; |
| 26388 | fusionAlg_B.ObjList.vision_09_obj.obj_Heading_STD = |
| 26389 | fusionAlg_P_g.Constant2_Value_cn; |
| 26390 | fusionAlg_B.ObjList.vision_09_obj.obj_Heading_V = |
| 26391 | fusionAlg_P_g.Constant3_Value_ae; |
| 26392 | fusionAlg_B.ObjList.vision_09_obj.obj_Heading_STD_V = |
| 26393 | fusionAlg_P_g.Constant4_Value_lv; |
| 26394 | |
| 26395 | /* Selector: '<S223>/Selector9' incorporates: |
| 26396 | * Constant: '<S223>/Constant9' |
| 26397 | */ |
| 26398 | fusionAlg_B.Selector9 = rtu_EyeQ4_Info_st-> |
| 26399 | OBJ_BUS[fusionAlg_P_g.Constant9_Value_me]; |
| 26400 | |
| 26401 | /* DataTypeConversion: '<S233>/Data Type Conversion' */ |
| 26402 | tmp = (real32_T)floor(fusionAlg_B.Selector9.OBJ_ID); |
| 26403 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26404 | tmp = 0.0F; |
| 26405 | } else { |
| 26406 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26407 | } |
| 26408 | |
| 26409 | fusionAlg_B.ObjList.vision_10_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 26410 | (uint32_T)-tmp : (uint32_T)tmp; |
| 26411 | |
| 26412 | /* End of DataTypeConversion: '<S233>/Data Type Conversion' */ |
| 26413 | |
| 26414 | /* Lookup_n-D: '<S294>/1-D Lookup Table' */ |
| 26415 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector9.OBJ_Measuring_Status, |
| 26416 | fusionAlg_P_g.uDLookupTable_bp01Data_g, 7U); |
| 26417 | fusionAlg_B.Obj_Status_iq = fusionAlg_P_g.uDLookupTable_tableData_bl[bpIdx]; |
| 26418 | |
| 26419 | /* DataTypeConversion: '<S294>/Data Type Conversion1' */ |
| 26420 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_iq); |
| 26421 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26422 | tmp = 0.0F; |
| 26423 | } else { |
| 26424 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26425 | } |
| 26426 | |
| 26427 | fusionAlg_B.ObjList.vision_10_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 26428 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 26429 | |
| 26430 | /* End of DataTypeConversion: '<S294>/Data Type Conversion1' */ |
| 26431 | |
| 26432 | /* DataTypeConversion: '<S285>/Data Type Conversion' */ |
| 26433 | tmp = (real32_T)floor(fusionAlg_B.Selector9.OBJ_Object_Age); |
| 26434 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26435 | tmp = 0.0F; |
| 26436 | } else { |
| 26437 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 26438 | } |
| 26439 | |
| 26440 | fusionAlg_B.measureAge_e = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 26441 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 26442 | |
| 26443 | /* End of DataTypeConversion: '<S285>/Data Type Conversion' */ |
| 26444 | |
| 26445 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' incorporates: |
| 26446 | * Constant: '<S285>/Constant' |
| 26447 | * Constant: '<S285>/Constant1' |
| 26448 | */ |
| 26449 | fusionAlg_B.ObjList.vision_10_obj.obj_stageAge.totalAge = |
| 26450 | fusionAlg_B.measureAge_e; |
| 26451 | fusionAlg_B.ObjList.vision_10_obj.obj_stageAge.initAge = |
| 26452 | fusionAlg_P_g.Constant_Value_h3; |
| 26453 | fusionAlg_B.ObjList.vision_10_obj.obj_stageAge.measureAge = |
| 26454 | fusionAlg_B.measureAge_e; |
| 26455 | fusionAlg_B.ObjList.vision_10_obj.obj_stageAge.predictAge = |
| 26456 | fusionAlg_P_g.Constant1_Value_py; |
| 26457 | |
| 26458 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' incorporates: |
| 26459 | * Constant: '<S286>/Constant' |
| 26460 | * Constant: '<S286>/Constant1' |
| 26461 | * Constant: '<S286>/Constant2' |
| 26462 | * Constant: '<S286>/Constant3' |
| 26463 | */ |
| 26464 | fusionAlg_B.ObjList.vision_10_obj.obj_boundary.X1 = |
| 26465 | fusionAlg_P_g.Constant_Value_ih; |
| 26466 | fusionAlg_B.ObjList.vision_10_obj.obj_boundary.Y1 = |
| 26467 | fusionAlg_P_g.Constant1_Value_fi; |
| 26468 | fusionAlg_B.ObjList.vision_10_obj.obj_boundary.X2 = |
| 26469 | fusionAlg_P_g.Constant2_Value_aqt; |
| 26470 | fusionAlg_B.ObjList.vision_10_obj.obj_boundary.Y2 = |
| 26471 | fusionAlg_P_g.Constant3_Value_p5; |
| 26472 | |
| 26473 | /* Lookup_n-D: '<S295>/1-D Lookup Table' */ |
| 26474 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector9.OBJ_Object_Class, |
| 26475 | fusionAlg_P_g.uDLookupTable_bp01Data_py, 8U); |
| 26476 | fusionAlg_B.Obj_Status_h0 = fusionAlg_P_g.uDLookupTable_tableData_p[bpIdx]; |
| 26477 | |
| 26478 | /* DataTypeConversion: '<S295>/Data Type Conversion2' */ |
| 26479 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_h0); |
| 26480 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26481 | tmp = 0.0F; |
| 26482 | } else { |
| 26483 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26484 | } |
| 26485 | |
| 26486 | fusionAlg_B.Obj_Type_f5 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26487 | (uint32_T)tmp; |
| 26488 | |
| 26489 | /* End of DataTypeConversion: '<S295>/Data Type Conversion2' */ |
| 26490 | |
| 26491 | /* DataTypeConversion: '<S233>/Data Type Conversion3' */ |
| 26492 | tmp = (real32_T)floor(fusionAlg_B.Selector9.OBJ_Class_Probability); |
| 26493 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26494 | tmp = 0.0F; |
| 26495 | } else { |
| 26496 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26497 | } |
| 26498 | |
| 26499 | fusionAlg_B.Obj_TypeConf_f = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26500 | (uint32_T)tmp; |
| 26501 | |
| 26502 | /* End of DataTypeConversion: '<S233>/Data Type Conversion3' */ |
| 26503 | |
| 26504 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' */ |
| 26505 | fusionAlg_B.ObjList.vision_10_obj.obj_coordinate.lateral = |
| 26506 | fusionAlg_B.Selector9.OBJ_Lat_Distance; |
| 26507 | fusionAlg_B.ObjList.vision_10_obj.obj_coordinate.lateralVariance = |
| 26508 | fusionAlg_B.Selector9.OBJ_Lat_Distance_STD; |
| 26509 | fusionAlg_B.ObjList.vision_10_obj.obj_coordinate.longitudinal = |
| 26510 | fusionAlg_B.Selector9.OBJ_Long_Distance; |
| 26511 | fusionAlg_B.ObjList.vision_10_obj.obj_coordinate.longitudinalVariance = |
| 26512 | fusionAlg_B.Selector9.OBJ_Long_Distance_STD; |
| 26513 | |
| 26514 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' */ |
| 26515 | fusionAlg_B.ObjList.vision_10_obj.obj_velocity.Vx = |
| 26516 | fusionAlg_B.Selector9.OBJ_Abs_Long_Velocity; |
| 26517 | fusionAlg_B.ObjList.vision_10_obj.obj_velocity.VxVariance = |
| 26518 | fusionAlg_B.Selector9.OBJ_Abs_Long_Velocity_STD; |
| 26519 | fusionAlg_B.ObjList.vision_10_obj.obj_velocity.Vy = |
| 26520 | fusionAlg_B.Selector9.OBJ_Abs_Lat_Velocity; |
| 26521 | fusionAlg_B.ObjList.vision_10_obj.obj_velocity.VyVariance = |
| 26522 | fusionAlg_B.Selector9.OBJ_Abs_Lat_Velocity_STD; |
| 26523 | |
| 26524 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' */ |
| 26525 | fusionAlg_B.ObjList.vision_10_obj.obj_angleOfCenter.centerAngle = |
| 26526 | fusionAlg_B.Selector9.OBJ_Angle_Mid; |
| 26527 | fusionAlg_B.ObjList.vision_10_obj.obj_angleOfCenter.centerAngleVariance = |
| 26528 | fusionAlg_B.Selector9.OBJ_Angle_Mid_STD; |
| 26529 | |
| 26530 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' */ |
| 26531 | fusionAlg_B.ObjList.vision_10_obj.obj_acceleration.Ax = |
| 26532 | fusionAlg_B.Selector9.OBJ_Abs_Long_Acc; |
| 26533 | fusionAlg_B.ObjList.vision_10_obj.obj_acceleration.AxVariance = |
| 26534 | fusionAlg_B.Selector9.OBJ_Abs_Long_Acc_STD; |
| 26535 | fusionAlg_B.ObjList.vision_10_obj.obj_acceleration.Ay = |
| 26536 | fusionAlg_B.Selector9.OBJ_Abs_Lat_Acc; |
| 26537 | fusionAlg_B.ObjList.vision_10_obj.obj_acceleration.AyVariance = |
| 26538 | fusionAlg_B.Selector9.OBJ_Abs_Lat_Acc_STD; |
| 26539 | |
| 26540 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' */ |
| 26541 | fusionAlg_B.ObjList.vision_10_obj.AyVariance.length = |
| 26542 | fusionAlg_B.Selector9.OBJ_Length; |
| 26543 | fusionAlg_B.ObjList.vision_10_obj.AyVariance.width = |
| 26544 | fusionAlg_B.Selector9.OBJ_Width; |
| 26545 | fusionAlg_B.ObjList.vision_10_obj.AyVariance.height = |
| 26546 | fusionAlg_B.Selector9.OBJ_Height; |
| 26547 | |
| 26548 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' incorporates: |
| 26549 | * Constant: '<S292>/Constant1' |
| 26550 | * Constant: '<S292>/Constant2' |
| 26551 | * Constant: '<S292>/Constant3' |
| 26552 | */ |
| 26553 | fusionAlg_B.ObjList.vision_10_obj.reserved1.reserved0 = |
| 26554 | fusionAlg_P_g.Constant2_Value_bc; |
| 26555 | fusionAlg_B.ObjList.vision_10_obj.reserved1.reserved1 = |
| 26556 | fusionAlg_P_g.Constant1_Value_gpq; |
| 26557 | fusionAlg_B.ObjList.vision_10_obj.reserved1.reserved2 = |
| 26558 | fusionAlg_P_g.Constant3_Value_nj; |
| 26559 | |
| 26560 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' incorporates: |
| 26561 | * Constant: '<S293>/Constant5' |
| 26562 | * Constant: '<S293>/Constant6' |
| 26563 | */ |
| 26564 | fusionAlg_B.ObjList.vision_10_obj.reserved2.reserved0 = |
| 26565 | fusionAlg_P_g.Constant5_Value_p2; |
| 26566 | fusionAlg_B.ObjList.vision_10_obj.reserved2.reserved1 = |
| 26567 | fusionAlg_P_g.Constant6_Value_lh; |
| 26568 | |
| 26569 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_9' incorporates: |
| 26570 | * Constant: '<S233>/Constant' |
| 26571 | * Constant: '<S233>/Constant1' |
| 26572 | * Constant: '<S233>/Constant2' |
| 26573 | * Constant: '<S233>/Constant3' |
| 26574 | * Constant: '<S233>/Constant4' |
| 26575 | */ |
| 26576 | fusionAlg_B.ObjList.vision_10_obj.obj_type = fusionAlg_B.Obj_Type_f5; |
| 26577 | fusionAlg_B.ObjList.vision_10_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_f; |
| 26578 | fusionAlg_B.ObjList.vision_10_obj.obj_TTC = fusionAlg_B.Selector9.OBJ_Inv_TTC; |
| 26579 | fusionAlg_B.ObjList.vision_10_obj.obj_TTCVariance = |
| 26580 | fusionAlg_B.Selector9.OBJ_Inv_TTC_STD; |
| 26581 | fusionAlg_B.ObjList.vision_10_obj.obj_existProb = |
| 26582 | fusionAlg_P_g.Constant_Value_er; |
| 26583 | fusionAlg_B.ObjList.vision_10_obj.obj_angleOfObject = |
| 26584 | fusionAlg_P_g.Constant1_Value_ecn; |
| 26585 | fusionAlg_B.ObjList.vision_10_obj.obj_Heading = |
| 26586 | fusionAlg_B.Selector9.OBJ_Heading; |
| 26587 | fusionAlg_B.ObjList.vision_10_obj.obj_Heading_STD = |
| 26588 | fusionAlg_P_g.Constant2_Value_m2; |
| 26589 | fusionAlg_B.ObjList.vision_10_obj.obj_Heading_V = |
| 26590 | fusionAlg_P_g.Constant3_Value_bp; |
| 26591 | fusionAlg_B.ObjList.vision_10_obj.obj_Heading_STD_V = |
| 26592 | fusionAlg_P_g.Constant4_Value_fm; |
| 26593 | |
| 26594 | /* Selector: '<S223>/Selector10' incorporates: |
| 26595 | * Constant: '<S223>/Constant10' |
| 26596 | */ |
| 26597 | fusionAlg_B.Selector10 = rtu_EyeQ4_Info_st-> |
| 26598 | OBJ_BUS[fusionAlg_P_g.Constant10_Value_mu]; |
| 26599 | |
| 26600 | /* DataTypeConversion: '<S234>/Data Type Conversion' */ |
| 26601 | tmp = (real32_T)floor(fusionAlg_B.Selector10.OBJ_ID); |
| 26602 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26603 | tmp = 0.0F; |
| 26604 | } else { |
| 26605 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26606 | } |
| 26607 | |
| 26608 | fusionAlg_B.ObjList.vision_11_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 26609 | (uint32_T)-tmp : (uint32_T)tmp; |
| 26610 | |
| 26611 | /* End of DataTypeConversion: '<S234>/Data Type Conversion' */ |
| 26612 | |
| 26613 | /* Lookup_n-D: '<S305>/1-D Lookup Table' */ |
| 26614 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector10.OBJ_Measuring_Status, |
| 26615 | fusionAlg_P_g.uDLookupTable_bp01Data_c, 7U); |
| 26616 | fusionAlg_B.Obj_Status_be = fusionAlg_P_g.uDLookupTable_tableData_pn[bpIdx]; |
| 26617 | |
| 26618 | /* DataTypeConversion: '<S305>/Data Type Conversion1' */ |
| 26619 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_be); |
| 26620 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26621 | tmp = 0.0F; |
| 26622 | } else { |
| 26623 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26624 | } |
| 26625 | |
| 26626 | fusionAlg_B.ObjList.vision_11_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 26627 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 26628 | |
| 26629 | /* End of DataTypeConversion: '<S305>/Data Type Conversion1' */ |
| 26630 | |
| 26631 | /* DataTypeConversion: '<S296>/Data Type Conversion' */ |
| 26632 | tmp = (real32_T)floor(fusionAlg_B.Selector10.OBJ_Object_Age); |
| 26633 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26634 | tmp = 0.0F; |
| 26635 | } else { |
| 26636 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 26637 | } |
| 26638 | |
| 26639 | fusionAlg_B.measureAge_c2 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 26640 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 26641 | |
| 26642 | /* End of DataTypeConversion: '<S296>/Data Type Conversion' */ |
| 26643 | |
| 26644 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' incorporates: |
| 26645 | * Constant: '<S296>/Constant' |
| 26646 | * Constant: '<S296>/Constant1' |
| 26647 | */ |
| 26648 | fusionAlg_B.ObjList.vision_11_obj.obj_stageAge.totalAge = |
| 26649 | fusionAlg_B.measureAge_c2; |
| 26650 | fusionAlg_B.ObjList.vision_11_obj.obj_stageAge.initAge = |
| 26651 | fusionAlg_P_g.Constant_Value_poe; |
| 26652 | fusionAlg_B.ObjList.vision_11_obj.obj_stageAge.measureAge = |
| 26653 | fusionAlg_B.measureAge_c2; |
| 26654 | fusionAlg_B.ObjList.vision_11_obj.obj_stageAge.predictAge = |
| 26655 | fusionAlg_P_g.Constant1_Value_iq; |
| 26656 | |
| 26657 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' incorporates: |
| 26658 | * Constant: '<S297>/Constant' |
| 26659 | * Constant: '<S297>/Constant1' |
| 26660 | * Constant: '<S297>/Constant2' |
| 26661 | * Constant: '<S297>/Constant3' |
| 26662 | */ |
| 26663 | fusionAlg_B.ObjList.vision_11_obj.obj_boundary.X1 = |
| 26664 | fusionAlg_P_g.Constant_Value_hv; |
| 26665 | fusionAlg_B.ObjList.vision_11_obj.obj_boundary.Y1 = |
| 26666 | fusionAlg_P_g.Constant1_Value_ep; |
| 26667 | fusionAlg_B.ObjList.vision_11_obj.obj_boundary.X2 = |
| 26668 | fusionAlg_P_g.Constant2_Value_nw; |
| 26669 | fusionAlg_B.ObjList.vision_11_obj.obj_boundary.Y2 = |
| 26670 | fusionAlg_P_g.Constant3_Value_fp; |
| 26671 | |
| 26672 | /* Lookup_n-D: '<S306>/1-D Lookup Table' */ |
| 26673 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector10.OBJ_Object_Class, |
| 26674 | fusionAlg_P_g.uDLookupTable_bp01Data_gr, 8U); |
| 26675 | fusionAlg_B.Obj_Status_g5 = fusionAlg_P_g.uDLookupTable_tableData_j5[bpIdx]; |
| 26676 | |
| 26677 | /* DataTypeConversion: '<S306>/Data Type Conversion2' */ |
| 26678 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_g5); |
| 26679 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26680 | tmp = 0.0F; |
| 26681 | } else { |
| 26682 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26683 | } |
| 26684 | |
| 26685 | fusionAlg_B.Obj_Type_b5 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26686 | (uint32_T)tmp; |
| 26687 | |
| 26688 | /* End of DataTypeConversion: '<S306>/Data Type Conversion2' */ |
| 26689 | |
| 26690 | /* DataTypeConversion: '<S234>/Data Type Conversion3' */ |
| 26691 | tmp = (real32_T)floor(fusionAlg_B.Selector10.OBJ_Class_Probability); |
| 26692 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26693 | tmp = 0.0F; |
| 26694 | } else { |
| 26695 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26696 | } |
| 26697 | |
| 26698 | fusionAlg_B.Obj_TypeConf_p = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26699 | (uint32_T)tmp; |
| 26700 | |
| 26701 | /* End of DataTypeConversion: '<S234>/Data Type Conversion3' */ |
| 26702 | |
| 26703 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' */ |
| 26704 | fusionAlg_B.ObjList.vision_11_obj.obj_coordinate.lateral = |
| 26705 | fusionAlg_B.Selector10.OBJ_Lat_Distance; |
| 26706 | fusionAlg_B.ObjList.vision_11_obj.obj_coordinate.lateralVariance = |
| 26707 | fusionAlg_B.Selector10.OBJ_Lat_Distance_STD; |
| 26708 | fusionAlg_B.ObjList.vision_11_obj.obj_coordinate.longitudinal = |
| 26709 | fusionAlg_B.Selector10.OBJ_Long_Distance; |
| 26710 | fusionAlg_B.ObjList.vision_11_obj.obj_coordinate.longitudinalVariance = |
| 26711 | fusionAlg_B.Selector10.OBJ_Long_Distance_STD; |
| 26712 | |
| 26713 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' */ |
| 26714 | fusionAlg_B.ObjList.vision_11_obj.obj_velocity.Vx = |
| 26715 | fusionAlg_B.Selector10.OBJ_Abs_Long_Velocity; |
| 26716 | fusionAlg_B.ObjList.vision_11_obj.obj_velocity.VxVariance = |
| 26717 | fusionAlg_B.Selector10.OBJ_Abs_Long_Velocity_STD; |
| 26718 | fusionAlg_B.ObjList.vision_11_obj.obj_velocity.Vy = |
| 26719 | fusionAlg_B.Selector10.OBJ_Abs_Lat_Velocity; |
| 26720 | fusionAlg_B.ObjList.vision_11_obj.obj_velocity.VyVariance = |
| 26721 | fusionAlg_B.Selector10.OBJ_Abs_Lat_Velocity_STD; |
| 26722 | |
| 26723 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' */ |
| 26724 | fusionAlg_B.ObjList.vision_11_obj.obj_angleOfCenter.centerAngle = |
| 26725 | fusionAlg_B.Selector10.OBJ_Angle_Mid; |
| 26726 | fusionAlg_B.ObjList.vision_11_obj.obj_angleOfCenter.centerAngleVariance = |
| 26727 | fusionAlg_B.Selector10.OBJ_Angle_Mid_STD; |
| 26728 | |
| 26729 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' */ |
| 26730 | fusionAlg_B.ObjList.vision_11_obj.obj_acceleration.Ax = |
| 26731 | fusionAlg_B.Selector10.OBJ_Abs_Long_Acc; |
| 26732 | fusionAlg_B.ObjList.vision_11_obj.obj_acceleration.AxVariance = |
| 26733 | fusionAlg_B.Selector10.OBJ_Abs_Long_Acc_STD; |
| 26734 | fusionAlg_B.ObjList.vision_11_obj.obj_acceleration.Ay = |
| 26735 | fusionAlg_B.Selector10.OBJ_Abs_Lat_Acc; |
| 26736 | fusionAlg_B.ObjList.vision_11_obj.obj_acceleration.AyVariance = |
| 26737 | fusionAlg_B.Selector10.OBJ_Abs_Lat_Acc_STD; |
| 26738 | |
| 26739 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' */ |
| 26740 | fusionAlg_B.ObjList.vision_11_obj.AyVariance.length = |
| 26741 | fusionAlg_B.Selector10.OBJ_Length; |
| 26742 | fusionAlg_B.ObjList.vision_11_obj.AyVariance.width = |
| 26743 | fusionAlg_B.Selector10.OBJ_Width; |
| 26744 | fusionAlg_B.ObjList.vision_11_obj.AyVariance.height = |
| 26745 | fusionAlg_B.Selector10.OBJ_Height; |
| 26746 | |
| 26747 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' incorporates: |
| 26748 | * Constant: '<S303>/Constant1' |
| 26749 | * Constant: '<S303>/Constant2' |
| 26750 | * Constant: '<S303>/Constant3' |
| 26751 | */ |
| 26752 | fusionAlg_B.ObjList.vision_11_obj.reserved1.reserved0 = |
| 26753 | fusionAlg_P_g.Constant2_Value_n5; |
| 26754 | fusionAlg_B.ObjList.vision_11_obj.reserved1.reserved1 = |
| 26755 | fusionAlg_P_g.Constant1_Value_hr; |
| 26756 | fusionAlg_B.ObjList.vision_11_obj.reserved1.reserved2 = |
| 26757 | fusionAlg_P_g.Constant3_Value_mx; |
| 26758 | |
| 26759 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' incorporates: |
| 26760 | * Constant: '<S304>/Constant5' |
| 26761 | * Constant: '<S304>/Constant6' |
| 26762 | */ |
| 26763 | fusionAlg_B.ObjList.vision_11_obj.reserved2.reserved0 = |
| 26764 | fusionAlg_P_g.Constant5_Value_fy; |
| 26765 | fusionAlg_B.ObjList.vision_11_obj.reserved2.reserved1 = |
| 26766 | fusionAlg_P_g.Constant6_Value_co; |
| 26767 | |
| 26768 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_10' incorporates: |
| 26769 | * Constant: '<S234>/Constant' |
| 26770 | * Constant: '<S234>/Constant1' |
| 26771 | * Constant: '<S234>/Constant2' |
| 26772 | * Constant: '<S234>/Constant3' |
| 26773 | * Constant: '<S234>/Constant4' |
| 26774 | */ |
| 26775 | fusionAlg_B.ObjList.vision_11_obj.obj_type = fusionAlg_B.Obj_Type_b5; |
| 26776 | fusionAlg_B.ObjList.vision_11_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_p; |
| 26777 | fusionAlg_B.ObjList.vision_11_obj.obj_TTC = fusionAlg_B.Selector10.OBJ_Inv_TTC; |
| 26778 | fusionAlg_B.ObjList.vision_11_obj.obj_TTCVariance = |
| 26779 | fusionAlg_B.Selector10.OBJ_Inv_TTC_STD; |
| 26780 | fusionAlg_B.ObjList.vision_11_obj.obj_existProb = |
| 26781 | fusionAlg_P_g.Constant_Value_h; |
| 26782 | fusionAlg_B.ObjList.vision_11_obj.obj_angleOfObject = |
| 26783 | fusionAlg_P_g.Constant1_Value_gr; |
| 26784 | fusionAlg_B.ObjList.vision_11_obj.obj_Heading = |
| 26785 | fusionAlg_B.Selector10.OBJ_Heading; |
| 26786 | fusionAlg_B.ObjList.vision_11_obj.obj_Heading_STD = |
| 26787 | fusionAlg_P_g.Constant2_Value_b2; |
| 26788 | fusionAlg_B.ObjList.vision_11_obj.obj_Heading_V = |
| 26789 | fusionAlg_P_g.Constant3_Value_f1; |
| 26790 | fusionAlg_B.ObjList.vision_11_obj.obj_Heading_STD_V = |
| 26791 | fusionAlg_P_g.Constant4_Value_o5; |
| 26792 | |
| 26793 | /* Selector: '<S223>/Selector11' incorporates: |
| 26794 | * Constant: '<S223>/Constant11' |
| 26795 | */ |
| 26796 | fusionAlg_B.Selector11 = rtu_EyeQ4_Info_st-> |
| 26797 | OBJ_BUS[fusionAlg_P_g.Constant11_Value_l]; |
| 26798 | |
| 26799 | /* DataTypeConversion: '<S235>/Data Type Conversion' */ |
| 26800 | tmp = (real32_T)floor(fusionAlg_B.Selector11.OBJ_ID); |
| 26801 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26802 | tmp = 0.0F; |
| 26803 | } else { |
| 26804 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26805 | } |
| 26806 | |
| 26807 | fusionAlg_B.ObjList.vision_12_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 26808 | (uint32_T)-tmp : (uint32_T)tmp; |
| 26809 | |
| 26810 | /* End of DataTypeConversion: '<S235>/Data Type Conversion' */ |
| 26811 | |
| 26812 | /* Lookup_n-D: '<S316>/1-D Lookup Table' */ |
| 26813 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector11.OBJ_Measuring_Status, |
| 26814 | fusionAlg_P_g.uDLookupTable_bp01Data_a, 7U); |
| 26815 | fusionAlg_B.Obj_Status_o4 = fusionAlg_P_g.uDLookupTable_tableData_bh[bpIdx]; |
| 26816 | |
| 26817 | /* DataTypeConversion: '<S316>/Data Type Conversion1' */ |
| 26818 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_o4); |
| 26819 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26820 | tmp = 0.0F; |
| 26821 | } else { |
| 26822 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26823 | } |
| 26824 | |
| 26825 | fusionAlg_B.ObjList.vision_12_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 26826 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 26827 | |
| 26828 | /* End of DataTypeConversion: '<S316>/Data Type Conversion1' */ |
| 26829 | |
| 26830 | /* DataTypeConversion: '<S307>/Data Type Conversion' */ |
| 26831 | tmp = (real32_T)floor(fusionAlg_B.Selector11.OBJ_Object_Age); |
| 26832 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26833 | tmp = 0.0F; |
| 26834 | } else { |
| 26835 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 26836 | } |
| 26837 | |
| 26838 | fusionAlg_B.measureAge_l = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 26839 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 26840 | |
| 26841 | /* End of DataTypeConversion: '<S307>/Data Type Conversion' */ |
| 26842 | |
| 26843 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' incorporates: |
| 26844 | * Constant: '<S307>/Constant' |
| 26845 | * Constant: '<S307>/Constant1' |
| 26846 | */ |
| 26847 | fusionAlg_B.ObjList.vision_12_obj.obj_stageAge.totalAge = |
| 26848 | fusionAlg_B.measureAge_l; |
| 26849 | fusionAlg_B.ObjList.vision_12_obj.obj_stageAge.initAge = |
| 26850 | fusionAlg_P_g.Constant_Value_gg; |
| 26851 | fusionAlg_B.ObjList.vision_12_obj.obj_stageAge.measureAge = |
| 26852 | fusionAlg_B.measureAge_l; |
| 26853 | fusionAlg_B.ObjList.vision_12_obj.obj_stageAge.predictAge = |
| 26854 | fusionAlg_P_g.Constant1_Value_dy; |
| 26855 | |
| 26856 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' incorporates: |
| 26857 | * Constant: '<S308>/Constant' |
| 26858 | * Constant: '<S308>/Constant1' |
| 26859 | * Constant: '<S308>/Constant2' |
| 26860 | * Constant: '<S308>/Constant3' |
| 26861 | */ |
| 26862 | fusionAlg_B.ObjList.vision_12_obj.obj_boundary.X1 = |
| 26863 | fusionAlg_P_g.Constant_Value_nnh; |
| 26864 | fusionAlg_B.ObjList.vision_12_obj.obj_boundary.Y1 = |
| 26865 | fusionAlg_P_g.Constant1_Value_cs; |
| 26866 | fusionAlg_B.ObjList.vision_12_obj.obj_boundary.X2 = |
| 26867 | fusionAlg_P_g.Constant2_Value_lq; |
| 26868 | fusionAlg_B.ObjList.vision_12_obj.obj_boundary.Y2 = |
| 26869 | fusionAlg_P_g.Constant3_Value_ls; |
| 26870 | |
| 26871 | /* Lookup_n-D: '<S317>/1-D Lookup Table' */ |
| 26872 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector11.OBJ_Object_Class, |
| 26873 | fusionAlg_P_g.uDLookupTable_bp01Data_cs, 8U); |
| 26874 | fusionAlg_B.Obj_Status_pr = fusionAlg_P_g.uDLookupTable_tableData_fm[bpIdx]; |
| 26875 | |
| 26876 | /* DataTypeConversion: '<S317>/Data Type Conversion2' */ |
| 26877 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_pr); |
| 26878 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26879 | tmp = 0.0F; |
| 26880 | } else { |
| 26881 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26882 | } |
| 26883 | |
| 26884 | fusionAlg_B.Obj_Type_ft = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26885 | (uint32_T)tmp; |
| 26886 | |
| 26887 | /* End of DataTypeConversion: '<S317>/Data Type Conversion2' */ |
| 26888 | |
| 26889 | /* DataTypeConversion: '<S235>/Data Type Conversion3' */ |
| 26890 | tmp = (real32_T)floor(fusionAlg_B.Selector11.OBJ_Class_Probability); |
| 26891 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 26892 | tmp = 0.0F; |
| 26893 | } else { |
| 26894 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 26895 | } |
| 26896 | |
| 26897 | fusionAlg_B.Obj_TypeConf_i = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 26898 | (uint32_T)tmp; |
| 26899 | |
| 26900 | /* End of DataTypeConversion: '<S235>/Data Type Conversion3' */ |
| 26901 | |
| 26902 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' */ |
| 26903 | fusionAlg_B.ObjList.vision_12_obj.obj_coordinate.lateral = |
| 26904 | fusionAlg_B.Selector11.OBJ_Lat_Distance; |
| 26905 | fusionAlg_B.ObjList.vision_12_obj.obj_coordinate.lateralVariance = |
| 26906 | fusionAlg_B.Selector11.OBJ_Lat_Distance_STD; |
| 26907 | fusionAlg_B.ObjList.vision_12_obj.obj_coordinate.longitudinal = |
| 26908 | fusionAlg_B.Selector11.OBJ_Long_Distance; |
| 26909 | fusionAlg_B.ObjList.vision_12_obj.obj_coordinate.longitudinalVariance = |
| 26910 | fusionAlg_B.Selector11.OBJ_Long_Distance_STD; |
| 26911 | |
| 26912 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' */ |
| 26913 | fusionAlg_B.ObjList.vision_12_obj.obj_velocity.Vx = |
| 26914 | fusionAlg_B.Selector11.OBJ_Abs_Long_Velocity; |
| 26915 | fusionAlg_B.ObjList.vision_12_obj.obj_velocity.VxVariance = |
| 26916 | fusionAlg_B.Selector11.OBJ_Abs_Long_Velocity_STD; |
| 26917 | fusionAlg_B.ObjList.vision_12_obj.obj_velocity.Vy = |
| 26918 | fusionAlg_B.Selector11.OBJ_Abs_Lat_Velocity; |
| 26919 | fusionAlg_B.ObjList.vision_12_obj.obj_velocity.VyVariance = |
| 26920 | fusionAlg_B.Selector11.OBJ_Abs_Lat_Velocity_STD; |
| 26921 | |
| 26922 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' */ |
| 26923 | fusionAlg_B.ObjList.vision_12_obj.obj_angleOfCenter.centerAngle = |
| 26924 | fusionAlg_B.Selector11.OBJ_Angle_Mid; |
| 26925 | fusionAlg_B.ObjList.vision_12_obj.obj_angleOfCenter.centerAngleVariance = |
| 26926 | fusionAlg_B.Selector11.OBJ_Angle_Mid_STD; |
| 26927 | |
| 26928 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' */ |
| 26929 | fusionAlg_B.ObjList.vision_12_obj.obj_acceleration.Ax = |
| 26930 | fusionAlg_B.Selector11.OBJ_Abs_Long_Acc; |
| 26931 | fusionAlg_B.ObjList.vision_12_obj.obj_acceleration.AxVariance = |
| 26932 | fusionAlg_B.Selector11.OBJ_Abs_Long_Acc_STD; |
| 26933 | fusionAlg_B.ObjList.vision_12_obj.obj_acceleration.Ay = |
| 26934 | fusionAlg_B.Selector11.OBJ_Abs_Lat_Acc; |
| 26935 | fusionAlg_B.ObjList.vision_12_obj.obj_acceleration.AyVariance = |
| 26936 | fusionAlg_B.Selector11.OBJ_Abs_Lat_Acc_STD; |
| 26937 | |
| 26938 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' */ |
| 26939 | fusionAlg_B.ObjList.vision_12_obj.AyVariance.length = |
| 26940 | fusionAlg_B.Selector11.OBJ_Length; |
| 26941 | fusionAlg_B.ObjList.vision_12_obj.AyVariance.width = |
| 26942 | fusionAlg_B.Selector11.OBJ_Width; |
| 26943 | fusionAlg_B.ObjList.vision_12_obj.AyVariance.height = |
| 26944 | fusionAlg_B.Selector11.OBJ_Height; |
| 26945 | |
| 26946 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' incorporates: |
| 26947 | * Constant: '<S314>/Constant1' |
| 26948 | * Constant: '<S314>/Constant2' |
| 26949 | * Constant: '<S314>/Constant3' |
| 26950 | */ |
| 26951 | fusionAlg_B.ObjList.vision_12_obj.reserved1.reserved0 = |
| 26952 | fusionAlg_P_g.Constant2_Value_pv; |
| 26953 | fusionAlg_B.ObjList.vision_12_obj.reserved1.reserved1 = |
| 26954 | fusionAlg_P_g.Constant1_Value_az; |
| 26955 | fusionAlg_B.ObjList.vision_12_obj.reserved1.reserved2 = |
| 26956 | fusionAlg_P_g.Constant3_Value_jv; |
| 26957 | |
| 26958 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' incorporates: |
| 26959 | * Constant: '<S315>/Constant5' |
| 26960 | * Constant: '<S315>/Constant6' |
| 26961 | */ |
| 26962 | fusionAlg_B.ObjList.vision_12_obj.reserved2.reserved0 = |
| 26963 | fusionAlg_P_g.Constant5_Value_fb; |
| 26964 | fusionAlg_B.ObjList.vision_12_obj.reserved2.reserved1 = |
| 26965 | fusionAlg_P_g.Constant6_Value_bup; |
| 26966 | |
| 26967 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_11' incorporates: |
| 26968 | * Constant: '<S235>/Constant' |
| 26969 | * Constant: '<S235>/Constant1' |
| 26970 | * Constant: '<S235>/Constant2' |
| 26971 | * Constant: '<S235>/Constant3' |
| 26972 | * Constant: '<S235>/Constant4' |
| 26973 | */ |
| 26974 | fusionAlg_B.ObjList.vision_12_obj.obj_type = fusionAlg_B.Obj_Type_ft; |
| 26975 | fusionAlg_B.ObjList.vision_12_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_i; |
| 26976 | fusionAlg_B.ObjList.vision_12_obj.obj_TTC = fusionAlg_B.Selector11.OBJ_Inv_TTC; |
| 26977 | fusionAlg_B.ObjList.vision_12_obj.obj_TTCVariance = |
| 26978 | fusionAlg_B.Selector11.OBJ_Inv_TTC_STD; |
| 26979 | fusionAlg_B.ObjList.vision_12_obj.obj_existProb = |
| 26980 | fusionAlg_P_g.Constant_Value_ax; |
| 26981 | fusionAlg_B.ObjList.vision_12_obj.obj_angleOfObject = |
| 26982 | fusionAlg_P_g.Constant1_Value_ak; |
| 26983 | fusionAlg_B.ObjList.vision_12_obj.obj_Heading = |
| 26984 | fusionAlg_B.Selector11.OBJ_Heading; |
| 26985 | fusionAlg_B.ObjList.vision_12_obj.obj_Heading_STD = |
| 26986 | fusionAlg_P_g.Constant2_Value_ho; |
| 26987 | fusionAlg_B.ObjList.vision_12_obj.obj_Heading_V = |
| 26988 | fusionAlg_P_g.Constant3_Value_os4; |
| 26989 | fusionAlg_B.ObjList.vision_12_obj.obj_Heading_STD_V = |
| 26990 | fusionAlg_P_g.Constant4_Value_jl; |
| 26991 | |
| 26992 | /* Selector: '<S223>/Selector12' incorporates: |
| 26993 | * Constant: '<S223>/Constant12' |
| 26994 | */ |
| 26995 | fusionAlg_B.Selector12 = rtu_EyeQ4_Info_st-> |
| 26996 | OBJ_BUS[fusionAlg_P_g.Constant12_Value_j]; |
| 26997 | |
| 26998 | /* DataTypeConversion: '<S236>/Data Type Conversion' */ |
| 26999 | tmp = (real32_T)floor(fusionAlg_B.Selector12.OBJ_ID); |
| 27000 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27001 | tmp = 0.0F; |
| 27002 | } else { |
| 27003 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27004 | } |
| 27005 | |
| 27006 | fusionAlg_B.ObjList.vision_13_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 27007 | (uint32_T)-tmp : (uint32_T)tmp; |
| 27008 | |
| 27009 | /* End of DataTypeConversion: '<S236>/Data Type Conversion' */ |
| 27010 | |
| 27011 | /* Lookup_n-D: '<S327>/1-D Lookup Table' */ |
| 27012 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector12.OBJ_Measuring_Status, |
| 27013 | fusionAlg_P_g.uDLookupTable_bp01Data_ka, 7U); |
| 27014 | fusionAlg_B.Obj_Status_pt = fusionAlg_P_g.uDLookupTable_tableData_i[bpIdx]; |
| 27015 | |
| 27016 | /* DataTypeConversion: '<S327>/Data Type Conversion1' */ |
| 27017 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_pt); |
| 27018 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27019 | tmp = 0.0F; |
| 27020 | } else { |
| 27021 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27022 | } |
| 27023 | |
| 27024 | fusionAlg_B.ObjList.vision_13_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 27025 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 27026 | |
| 27027 | /* End of DataTypeConversion: '<S327>/Data Type Conversion1' */ |
| 27028 | |
| 27029 | /* DataTypeConversion: '<S318>/Data Type Conversion' */ |
| 27030 | tmp = (real32_T)floor(fusionAlg_B.Selector12.OBJ_Object_Age); |
| 27031 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27032 | tmp = 0.0F; |
| 27033 | } else { |
| 27034 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 27035 | } |
| 27036 | |
| 27037 | fusionAlg_B.measureAge_n = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 27038 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 27039 | |
| 27040 | /* End of DataTypeConversion: '<S318>/Data Type Conversion' */ |
| 27041 | |
| 27042 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' incorporates: |
| 27043 | * Constant: '<S318>/Constant' |
| 27044 | * Constant: '<S318>/Constant1' |
| 27045 | */ |
| 27046 | fusionAlg_B.ObjList.vision_13_obj.obj_stageAge.totalAge = |
| 27047 | fusionAlg_B.measureAge_n; |
| 27048 | fusionAlg_B.ObjList.vision_13_obj.obj_stageAge.initAge = |
| 27049 | fusionAlg_P_g.Constant_Value_eo; |
| 27050 | fusionAlg_B.ObjList.vision_13_obj.obj_stageAge.measureAge = |
| 27051 | fusionAlg_B.measureAge_n; |
| 27052 | fusionAlg_B.ObjList.vision_13_obj.obj_stageAge.predictAge = |
| 27053 | fusionAlg_P_g.Constant1_Value_ae; |
| 27054 | |
| 27055 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' incorporates: |
| 27056 | * Constant: '<S319>/Constant' |
| 27057 | * Constant: '<S319>/Constant1' |
| 27058 | * Constant: '<S319>/Constant2' |
| 27059 | * Constant: '<S319>/Constant3' |
| 27060 | */ |
| 27061 | fusionAlg_B.ObjList.vision_13_obj.obj_boundary.X1 = |
| 27062 | fusionAlg_P_g.Constant_Value_fs; |
| 27063 | fusionAlg_B.ObjList.vision_13_obj.obj_boundary.Y1 = |
| 27064 | fusionAlg_P_g.Constant1_Value_a; |
| 27065 | fusionAlg_B.ObjList.vision_13_obj.obj_boundary.X2 = |
| 27066 | fusionAlg_P_g.Constant2_Value_bj; |
| 27067 | fusionAlg_B.ObjList.vision_13_obj.obj_boundary.Y2 = |
| 27068 | fusionAlg_P_g.Constant3_Value_gt; |
| 27069 | |
| 27070 | /* Lookup_n-D: '<S328>/1-D Lookup Table' */ |
| 27071 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector12.OBJ_Object_Class, |
| 27072 | fusionAlg_P_g.uDLookupTable_bp01Data_lxz, 8U); |
| 27073 | fusionAlg_B.Obj_Status_hr = fusionAlg_P_g.uDLookupTable_tableData_ds[bpIdx]; |
| 27074 | |
| 27075 | /* DataTypeConversion: '<S328>/Data Type Conversion2' */ |
| 27076 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_hr); |
| 27077 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27078 | tmp = 0.0F; |
| 27079 | } else { |
| 27080 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27081 | } |
| 27082 | |
| 27083 | fusionAlg_B.Obj_Type_ek = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27084 | (uint32_T)tmp; |
| 27085 | |
| 27086 | /* End of DataTypeConversion: '<S328>/Data Type Conversion2' */ |
| 27087 | |
| 27088 | /* DataTypeConversion: '<S236>/Data Type Conversion3' */ |
| 27089 | tmp = (real32_T)floor(fusionAlg_B.Selector12.OBJ_Class_Probability); |
| 27090 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27091 | tmp = 0.0F; |
| 27092 | } else { |
| 27093 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27094 | } |
| 27095 | |
| 27096 | fusionAlg_B.Obj_TypeConf_n = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27097 | (uint32_T)tmp; |
| 27098 | |
| 27099 | /* End of DataTypeConversion: '<S236>/Data Type Conversion3' */ |
| 27100 | |
| 27101 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' */ |
| 27102 | fusionAlg_B.ObjList.vision_13_obj.obj_coordinate.lateral = |
| 27103 | fusionAlg_B.Selector12.OBJ_Lat_Distance; |
| 27104 | fusionAlg_B.ObjList.vision_13_obj.obj_coordinate.lateralVariance = |
| 27105 | fusionAlg_B.Selector12.OBJ_Lat_Distance_STD; |
| 27106 | fusionAlg_B.ObjList.vision_13_obj.obj_coordinate.longitudinal = |
| 27107 | fusionAlg_B.Selector12.OBJ_Long_Distance; |
| 27108 | fusionAlg_B.ObjList.vision_13_obj.obj_coordinate.longitudinalVariance = |
| 27109 | fusionAlg_B.Selector12.OBJ_Long_Distance_STD; |
| 27110 | |
| 27111 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' */ |
| 27112 | fusionAlg_B.ObjList.vision_13_obj.obj_velocity.Vx = |
| 27113 | fusionAlg_B.Selector12.OBJ_Abs_Long_Velocity; |
| 27114 | fusionAlg_B.ObjList.vision_13_obj.obj_velocity.VxVariance = |
| 27115 | fusionAlg_B.Selector12.OBJ_Abs_Long_Velocity_STD; |
| 27116 | fusionAlg_B.ObjList.vision_13_obj.obj_velocity.Vy = |
| 27117 | fusionAlg_B.Selector12.OBJ_Abs_Lat_Velocity; |
| 27118 | fusionAlg_B.ObjList.vision_13_obj.obj_velocity.VyVariance = |
| 27119 | fusionAlg_B.Selector12.OBJ_Abs_Lat_Velocity_STD; |
| 27120 | |
| 27121 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' */ |
| 27122 | fusionAlg_B.ObjList.vision_13_obj.obj_angleOfCenter.centerAngle = |
| 27123 | fusionAlg_B.Selector12.OBJ_Angle_Mid; |
| 27124 | fusionAlg_B.ObjList.vision_13_obj.obj_angleOfCenter.centerAngleVariance = |
| 27125 | fusionAlg_B.Selector12.OBJ_Angle_Mid_STD; |
| 27126 | |
| 27127 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' */ |
| 27128 | fusionAlg_B.ObjList.vision_13_obj.obj_acceleration.Ax = |
| 27129 | fusionAlg_B.Selector12.OBJ_Abs_Long_Acc; |
| 27130 | fusionAlg_B.ObjList.vision_13_obj.obj_acceleration.AxVariance = |
| 27131 | fusionAlg_B.Selector12.OBJ_Abs_Long_Acc_STD; |
| 27132 | fusionAlg_B.ObjList.vision_13_obj.obj_acceleration.Ay = |
| 27133 | fusionAlg_B.Selector12.OBJ_Abs_Lat_Acc; |
| 27134 | fusionAlg_B.ObjList.vision_13_obj.obj_acceleration.AyVariance = |
| 27135 | fusionAlg_B.Selector12.OBJ_Abs_Lat_Acc_STD; |
| 27136 | |
| 27137 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' */ |
| 27138 | fusionAlg_B.ObjList.vision_13_obj.AyVariance.length = |
| 27139 | fusionAlg_B.Selector12.OBJ_Length; |
| 27140 | fusionAlg_B.ObjList.vision_13_obj.AyVariance.width = |
| 27141 | fusionAlg_B.Selector12.OBJ_Width; |
| 27142 | fusionAlg_B.ObjList.vision_13_obj.AyVariance.height = |
| 27143 | fusionAlg_B.Selector12.OBJ_Height; |
| 27144 | |
| 27145 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' incorporates: |
| 27146 | * Constant: '<S325>/Constant1' |
| 27147 | * Constant: '<S325>/Constant2' |
| 27148 | * Constant: '<S325>/Constant3' |
| 27149 | */ |
| 27150 | fusionAlg_B.ObjList.vision_13_obj.reserved1.reserved0 = |
| 27151 | fusionAlg_P_g.Constant2_Value_fw; |
| 27152 | fusionAlg_B.ObjList.vision_13_obj.reserved1.reserved1 = |
| 27153 | fusionAlg_P_g.Constant1_Value_fua; |
| 27154 | fusionAlg_B.ObjList.vision_13_obj.reserved1.reserved2 = |
| 27155 | fusionAlg_P_g.Constant3_Value_ep; |
| 27156 | |
| 27157 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' incorporates: |
| 27158 | * Constant: '<S326>/Constant5' |
| 27159 | * Constant: '<S326>/Constant6' |
| 27160 | */ |
| 27161 | fusionAlg_B.ObjList.vision_13_obj.reserved2.reserved0 = |
| 27162 | fusionAlg_P_g.Constant5_Value_cl; |
| 27163 | fusionAlg_B.ObjList.vision_13_obj.reserved2.reserved1 = |
| 27164 | fusionAlg_P_g.Constant6_Value_le; |
| 27165 | |
| 27166 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_12' incorporates: |
| 27167 | * Constant: '<S236>/Constant' |
| 27168 | * Constant: '<S236>/Constant1' |
| 27169 | * Constant: '<S236>/Constant2' |
| 27170 | * Constant: '<S236>/Constant3' |
| 27171 | * Constant: '<S236>/Constant4' |
| 27172 | */ |
| 27173 | fusionAlg_B.ObjList.vision_13_obj.obj_type = fusionAlg_B.Obj_Type_ek; |
| 27174 | fusionAlg_B.ObjList.vision_13_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_n; |
| 27175 | fusionAlg_B.ObjList.vision_13_obj.obj_TTC = fusionAlg_B.Selector12.OBJ_Inv_TTC; |
| 27176 | fusionAlg_B.ObjList.vision_13_obj.obj_TTCVariance = |
| 27177 | fusionAlg_B.Selector12.OBJ_Inv_TTC_STD; |
| 27178 | fusionAlg_B.ObjList.vision_13_obj.obj_existProb = |
| 27179 | fusionAlg_P_g.Constant_Value_p; |
| 27180 | fusionAlg_B.ObjList.vision_13_obj.obj_angleOfObject = |
| 27181 | fusionAlg_P_g.Constant1_Value_n5; |
| 27182 | fusionAlg_B.ObjList.vision_13_obj.obj_Heading = |
| 27183 | fusionAlg_B.Selector12.OBJ_Heading; |
| 27184 | fusionAlg_B.ObjList.vision_13_obj.obj_Heading_STD = |
| 27185 | fusionAlg_P_g.Constant2_Value_c4; |
| 27186 | fusionAlg_B.ObjList.vision_13_obj.obj_Heading_V = |
| 27187 | fusionAlg_P_g.Constant3_Value_hol; |
| 27188 | fusionAlg_B.ObjList.vision_13_obj.obj_Heading_STD_V = |
| 27189 | fusionAlg_P_g.Constant4_Value_cv; |
| 27190 | |
| 27191 | /* Selector: '<S223>/Selector13' incorporates: |
| 27192 | * Constant: '<S223>/Constant13' |
| 27193 | */ |
| 27194 | fusionAlg_B.Selector13 = rtu_EyeQ4_Info_st-> |
| 27195 | OBJ_BUS[fusionAlg_P_g.Constant13_Value_a]; |
| 27196 | |
| 27197 | /* DataTypeConversion: '<S237>/Data Type Conversion' */ |
| 27198 | tmp = (real32_T)floor(fusionAlg_B.Selector13.OBJ_ID); |
| 27199 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27200 | tmp = 0.0F; |
| 27201 | } else { |
| 27202 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27203 | } |
| 27204 | |
| 27205 | fusionAlg_B.ObjList.vision_14_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 27206 | (uint32_T)-tmp : (uint32_T)tmp; |
| 27207 | |
| 27208 | /* End of DataTypeConversion: '<S237>/Data Type Conversion' */ |
| 27209 | |
| 27210 | /* Lookup_n-D: '<S338>/1-D Lookup Table' */ |
| 27211 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector13.OBJ_Measuring_Status, |
| 27212 | fusionAlg_P_g.uDLookupTable_bp01Data_hh, 7U); |
| 27213 | fusionAlg_B.Obj_Status_fe = fusionAlg_P_g.uDLookupTable_tableData_ax[bpIdx]; |
| 27214 | |
| 27215 | /* DataTypeConversion: '<S338>/Data Type Conversion1' */ |
| 27216 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_fe); |
| 27217 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27218 | tmp = 0.0F; |
| 27219 | } else { |
| 27220 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27221 | } |
| 27222 | |
| 27223 | fusionAlg_B.ObjList.vision_14_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 27224 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 27225 | |
| 27226 | /* End of DataTypeConversion: '<S338>/Data Type Conversion1' */ |
| 27227 | |
| 27228 | /* DataTypeConversion: '<S329>/Data Type Conversion' */ |
| 27229 | tmp = (real32_T)floor(fusionAlg_B.Selector13.OBJ_Object_Age); |
| 27230 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27231 | tmp = 0.0F; |
| 27232 | } else { |
| 27233 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 27234 | } |
| 27235 | |
| 27236 | fusionAlg_B.measureAge_k = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 27237 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 27238 | |
| 27239 | /* End of DataTypeConversion: '<S329>/Data Type Conversion' */ |
| 27240 | |
| 27241 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' incorporates: |
| 27242 | * Constant: '<S329>/Constant' |
| 27243 | * Constant: '<S329>/Constant1' |
| 27244 | */ |
| 27245 | fusionAlg_B.ObjList.vision_14_obj.obj_stageAge.totalAge = |
| 27246 | fusionAlg_B.measureAge_k; |
| 27247 | fusionAlg_B.ObjList.vision_14_obj.obj_stageAge.initAge = |
| 27248 | fusionAlg_P_g.Constant_Value_b1; |
| 27249 | fusionAlg_B.ObjList.vision_14_obj.obj_stageAge.measureAge = |
| 27250 | fusionAlg_B.measureAge_k; |
| 27251 | fusionAlg_B.ObjList.vision_14_obj.obj_stageAge.predictAge = |
| 27252 | fusionAlg_P_g.Constant1_Value_at; |
| 27253 | |
| 27254 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' incorporates: |
| 27255 | * Constant: '<S330>/Constant' |
| 27256 | * Constant: '<S330>/Constant1' |
| 27257 | * Constant: '<S330>/Constant2' |
| 27258 | * Constant: '<S330>/Constant3' |
| 27259 | */ |
| 27260 | fusionAlg_B.ObjList.vision_14_obj.obj_boundary.X1 = |
| 27261 | fusionAlg_P_g.Constant_Value_by; |
| 27262 | fusionAlg_B.ObjList.vision_14_obj.obj_boundary.Y1 = |
| 27263 | fusionAlg_P_g.Constant1_Value_ei; |
| 27264 | fusionAlg_B.ObjList.vision_14_obj.obj_boundary.X2 = |
| 27265 | fusionAlg_P_g.Constant2_Value_mx; |
| 27266 | fusionAlg_B.ObjList.vision_14_obj.obj_boundary.Y2 = |
| 27267 | fusionAlg_P_g.Constant3_Value_dqd; |
| 27268 | |
| 27269 | /* Lookup_n-D: '<S339>/1-D Lookup Table' */ |
| 27270 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector13.OBJ_Object_Class, |
| 27271 | fusionAlg_P_g.uDLookupTable_bp01Data_as, 8U); |
| 27272 | fusionAlg_B.Obj_Status_f0 = fusionAlg_P_g.uDLookupTable_tableData_as[bpIdx]; |
| 27273 | |
| 27274 | /* DataTypeConversion: '<S339>/Data Type Conversion2' */ |
| 27275 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_f0); |
| 27276 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27277 | tmp = 0.0F; |
| 27278 | } else { |
| 27279 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27280 | } |
| 27281 | |
| 27282 | fusionAlg_B.Obj_Type_ht = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27283 | (uint32_T)tmp; |
| 27284 | |
| 27285 | /* End of DataTypeConversion: '<S339>/Data Type Conversion2' */ |
| 27286 | |
| 27287 | /* DataTypeConversion: '<S237>/Data Type Conversion3' */ |
| 27288 | tmp = (real32_T)floor(fusionAlg_B.Selector13.OBJ_Class_Probability); |
| 27289 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27290 | tmp = 0.0F; |
| 27291 | } else { |
| 27292 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27293 | } |
| 27294 | |
| 27295 | fusionAlg_B.Obj_TypeConf_af = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27296 | (uint32_T)tmp; |
| 27297 | |
| 27298 | /* End of DataTypeConversion: '<S237>/Data Type Conversion3' */ |
| 27299 | |
| 27300 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' */ |
| 27301 | fusionAlg_B.ObjList.vision_14_obj.obj_coordinate.lateral = |
| 27302 | fusionAlg_B.Selector13.OBJ_Lat_Distance; |
| 27303 | fusionAlg_B.ObjList.vision_14_obj.obj_coordinate.lateralVariance = |
| 27304 | fusionAlg_B.Selector13.OBJ_Lat_Distance_STD; |
| 27305 | fusionAlg_B.ObjList.vision_14_obj.obj_coordinate.longitudinal = |
| 27306 | fusionAlg_B.Selector13.OBJ_Long_Distance; |
| 27307 | fusionAlg_B.ObjList.vision_14_obj.obj_coordinate.longitudinalVariance = |
| 27308 | fusionAlg_B.Selector13.OBJ_Long_Distance_STD; |
| 27309 | |
| 27310 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' */ |
| 27311 | fusionAlg_B.ObjList.vision_14_obj.obj_velocity.Vx = |
| 27312 | fusionAlg_B.Selector13.OBJ_Abs_Long_Velocity; |
| 27313 | fusionAlg_B.ObjList.vision_14_obj.obj_velocity.VxVariance = |
| 27314 | fusionAlg_B.Selector13.OBJ_Abs_Long_Velocity_STD; |
| 27315 | fusionAlg_B.ObjList.vision_14_obj.obj_velocity.Vy = |
| 27316 | fusionAlg_B.Selector13.OBJ_Abs_Lat_Velocity; |
| 27317 | fusionAlg_B.ObjList.vision_14_obj.obj_velocity.VyVariance = |
| 27318 | fusionAlg_B.Selector13.OBJ_Abs_Lat_Velocity_STD; |
| 27319 | |
| 27320 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' */ |
| 27321 | fusionAlg_B.ObjList.vision_14_obj.obj_angleOfCenter.centerAngle = |
| 27322 | fusionAlg_B.Selector13.OBJ_Angle_Mid; |
| 27323 | fusionAlg_B.ObjList.vision_14_obj.obj_angleOfCenter.centerAngleVariance = |
| 27324 | fusionAlg_B.Selector13.OBJ_Angle_Mid_STD; |
| 27325 | |
| 27326 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' */ |
| 27327 | fusionAlg_B.ObjList.vision_14_obj.obj_acceleration.Ax = |
| 27328 | fusionAlg_B.Selector13.OBJ_Abs_Long_Acc; |
| 27329 | fusionAlg_B.ObjList.vision_14_obj.obj_acceleration.AxVariance = |
| 27330 | fusionAlg_B.Selector13.OBJ_Abs_Long_Acc_STD; |
| 27331 | fusionAlg_B.ObjList.vision_14_obj.obj_acceleration.Ay = |
| 27332 | fusionAlg_B.Selector13.OBJ_Abs_Lat_Acc; |
| 27333 | fusionAlg_B.ObjList.vision_14_obj.obj_acceleration.AyVariance = |
| 27334 | fusionAlg_B.Selector13.OBJ_Abs_Lat_Acc_STD; |
| 27335 | |
| 27336 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' */ |
| 27337 | fusionAlg_B.ObjList.vision_14_obj.AyVariance.length = |
| 27338 | fusionAlg_B.Selector13.OBJ_Length; |
| 27339 | fusionAlg_B.ObjList.vision_14_obj.AyVariance.width = |
| 27340 | fusionAlg_B.Selector13.OBJ_Width; |
| 27341 | fusionAlg_B.ObjList.vision_14_obj.AyVariance.height = |
| 27342 | fusionAlg_B.Selector13.OBJ_Height; |
| 27343 | |
| 27344 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' incorporates: |
| 27345 | * Constant: '<S336>/Constant1' |
| 27346 | * Constant: '<S336>/Constant2' |
| 27347 | * Constant: '<S336>/Constant3' |
| 27348 | */ |
| 27349 | fusionAlg_B.ObjList.vision_14_obj.reserved1.reserved0 = |
| 27350 | fusionAlg_P_g.Constant2_Value_bk; |
| 27351 | fusionAlg_B.ObjList.vision_14_obj.reserved1.reserved1 = |
| 27352 | fusionAlg_P_g.Constant1_Value_ghf; |
| 27353 | fusionAlg_B.ObjList.vision_14_obj.reserved1.reserved2 = |
| 27354 | fusionAlg_P_g.Constant3_Value_ey; |
| 27355 | |
| 27356 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' incorporates: |
| 27357 | * Constant: '<S337>/Constant5' |
| 27358 | * Constant: '<S337>/Constant6' |
| 27359 | */ |
| 27360 | fusionAlg_B.ObjList.vision_14_obj.reserved2.reserved0 = |
| 27361 | fusionAlg_P_g.Constant5_Value_j2; |
| 27362 | fusionAlg_B.ObjList.vision_14_obj.reserved2.reserved1 = |
| 27363 | fusionAlg_P_g.Constant6_Value_fzv; |
| 27364 | |
| 27365 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_13' incorporates: |
| 27366 | * Constant: '<S237>/Constant' |
| 27367 | * Constant: '<S237>/Constant1' |
| 27368 | * Constant: '<S237>/Constant2' |
| 27369 | * Constant: '<S237>/Constant3' |
| 27370 | * Constant: '<S237>/Constant4' |
| 27371 | */ |
| 27372 | fusionAlg_B.ObjList.vision_14_obj.obj_type = fusionAlg_B.Obj_Type_ht; |
| 27373 | fusionAlg_B.ObjList.vision_14_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_af; |
| 27374 | fusionAlg_B.ObjList.vision_14_obj.obj_TTC = fusionAlg_B.Selector13.OBJ_Inv_TTC; |
| 27375 | fusionAlg_B.ObjList.vision_14_obj.obj_TTCVariance = |
| 27376 | fusionAlg_B.Selector13.OBJ_Inv_TTC_STD; |
| 27377 | fusionAlg_B.ObjList.vision_14_obj.obj_existProb = |
| 27378 | fusionAlg_P_g.Constant_Value_j; |
| 27379 | fusionAlg_B.ObjList.vision_14_obj.obj_angleOfObject = |
| 27380 | fusionAlg_P_g.Constant1_Value_p2k; |
| 27381 | fusionAlg_B.ObjList.vision_14_obj.obj_Heading = |
| 27382 | fusionAlg_B.Selector13.OBJ_Heading; |
| 27383 | fusionAlg_B.ObjList.vision_14_obj.obj_Heading_STD = |
| 27384 | fusionAlg_P_g.Constant2_Value_l3; |
| 27385 | fusionAlg_B.ObjList.vision_14_obj.obj_Heading_V = |
| 27386 | fusionAlg_P_g.Constant3_Value_a5; |
| 27387 | fusionAlg_B.ObjList.vision_14_obj.obj_Heading_STD_V = |
| 27388 | fusionAlg_P_g.Constant4_Value_af; |
| 27389 | |
| 27390 | /* Selector: '<S223>/Selector14' incorporates: |
| 27391 | * Constant: '<S223>/Constant14' |
| 27392 | */ |
| 27393 | fusionAlg_B.Selector14 = rtu_EyeQ4_Info_st-> |
| 27394 | OBJ_BUS[fusionAlg_P_g.Constant14_Value_i]; |
| 27395 | |
| 27396 | /* DataTypeConversion: '<S238>/Data Type Conversion' */ |
| 27397 | tmp = (real32_T)floor(fusionAlg_B.Selector14.OBJ_ID); |
| 27398 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27399 | tmp = 0.0F; |
| 27400 | } else { |
| 27401 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27402 | } |
| 27403 | |
| 27404 | fusionAlg_B.ObjList.vision_15_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 27405 | (uint32_T)-tmp : (uint32_T)tmp; |
| 27406 | |
| 27407 | /* End of DataTypeConversion: '<S238>/Data Type Conversion' */ |
| 27408 | |
| 27409 | /* Lookup_n-D: '<S349>/1-D Lookup Table' */ |
| 27410 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector14.OBJ_Measuring_Status, |
| 27411 | fusionAlg_P_g.uDLookupTable_bp01Data_a3, 7U); |
| 27412 | fusionAlg_B.Obj_Status_o1 = fusionAlg_P_g.uDLookupTable_tableData_nv[bpIdx]; |
| 27413 | |
| 27414 | /* DataTypeConversion: '<S349>/Data Type Conversion1' */ |
| 27415 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_o1); |
| 27416 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27417 | tmp = 0.0F; |
| 27418 | } else { |
| 27419 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27420 | } |
| 27421 | |
| 27422 | fusionAlg_B.ObjList.vision_15_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 27423 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 27424 | |
| 27425 | /* End of DataTypeConversion: '<S349>/Data Type Conversion1' */ |
| 27426 | |
| 27427 | /* DataTypeConversion: '<S340>/Data Type Conversion' */ |
| 27428 | tmp = (real32_T)floor(fusionAlg_B.Selector14.OBJ_Object_Age); |
| 27429 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27430 | tmp = 0.0F; |
| 27431 | } else { |
| 27432 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 27433 | } |
| 27434 | |
| 27435 | fusionAlg_B.measureAge_kx = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 27436 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 27437 | |
| 27438 | /* End of DataTypeConversion: '<S340>/Data Type Conversion' */ |
| 27439 | |
| 27440 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' incorporates: |
| 27441 | * Constant: '<S340>/Constant' |
| 27442 | * Constant: '<S340>/Constant1' |
| 27443 | */ |
| 27444 | fusionAlg_B.ObjList.vision_15_obj.obj_stageAge.totalAge = |
| 27445 | fusionAlg_B.measureAge_kx; |
| 27446 | fusionAlg_B.ObjList.vision_15_obj.obj_stageAge.initAge = |
| 27447 | fusionAlg_P_g.Constant_Value_go; |
| 27448 | fusionAlg_B.ObjList.vision_15_obj.obj_stageAge.measureAge = |
| 27449 | fusionAlg_B.measureAge_kx; |
| 27450 | fusionAlg_B.ObjList.vision_15_obj.obj_stageAge.predictAge = |
| 27451 | fusionAlg_P_g.Constant1_Value_ms; |
| 27452 | |
| 27453 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' incorporates: |
| 27454 | * Constant: '<S341>/Constant' |
| 27455 | * Constant: '<S341>/Constant1' |
| 27456 | * Constant: '<S341>/Constant2' |
| 27457 | * Constant: '<S341>/Constant3' |
| 27458 | */ |
| 27459 | fusionAlg_B.ObjList.vision_15_obj.obj_boundary.X1 = |
| 27460 | fusionAlg_P_g.Constant_Value_nr; |
| 27461 | fusionAlg_B.ObjList.vision_15_obj.obj_boundary.Y1 = |
| 27462 | fusionAlg_P_g.Constant1_Value_d4; |
| 27463 | fusionAlg_B.ObjList.vision_15_obj.obj_boundary.X2 = |
| 27464 | fusionAlg_P_g.Constant2_Value_gyg; |
| 27465 | fusionAlg_B.ObjList.vision_15_obj.obj_boundary.Y2 = |
| 27466 | fusionAlg_P_g.Constant3_Value_ovb; |
| 27467 | |
| 27468 | /* Lookup_n-D: '<S350>/1-D Lookup Table' */ |
| 27469 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector14.OBJ_Object_Class, |
| 27470 | fusionAlg_P_g.uDLookupTable_bp01Data_cj, 8U); |
| 27471 | fusionAlg_B.Obj_Status_hg = fusionAlg_P_g.uDLookupTable_tableData_mhc[bpIdx]; |
| 27472 | |
| 27473 | /* DataTypeConversion: '<S350>/Data Type Conversion2' */ |
| 27474 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_hg); |
| 27475 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27476 | tmp = 0.0F; |
| 27477 | } else { |
| 27478 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27479 | } |
| 27480 | |
| 27481 | fusionAlg_B.Obj_Type_en = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27482 | (uint32_T)tmp; |
| 27483 | |
| 27484 | /* End of DataTypeConversion: '<S350>/Data Type Conversion2' */ |
| 27485 | |
| 27486 | /* DataTypeConversion: '<S238>/Data Type Conversion3' */ |
| 27487 | tmp = (real32_T)floor(fusionAlg_B.Selector14.OBJ_Class_Probability); |
| 27488 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27489 | tmp = 0.0F; |
| 27490 | } else { |
| 27491 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27492 | } |
| 27493 | |
| 27494 | fusionAlg_B.Obj_TypeConf_de = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27495 | (uint32_T)tmp; |
| 27496 | |
| 27497 | /* End of DataTypeConversion: '<S238>/Data Type Conversion3' */ |
| 27498 | |
| 27499 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' */ |
| 27500 | fusionAlg_B.ObjList.vision_15_obj.obj_coordinate.lateral = |
| 27501 | fusionAlg_B.Selector14.OBJ_Lat_Distance; |
| 27502 | fusionAlg_B.ObjList.vision_15_obj.obj_coordinate.lateralVariance = |
| 27503 | fusionAlg_B.Selector14.OBJ_Lat_Distance_STD; |
| 27504 | fusionAlg_B.ObjList.vision_15_obj.obj_coordinate.longitudinal = |
| 27505 | fusionAlg_B.Selector14.OBJ_Long_Distance; |
| 27506 | fusionAlg_B.ObjList.vision_15_obj.obj_coordinate.longitudinalVariance = |
| 27507 | fusionAlg_B.Selector14.OBJ_Long_Distance_STD; |
| 27508 | |
| 27509 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' */ |
| 27510 | fusionAlg_B.ObjList.vision_15_obj.obj_velocity.Vx = |
| 27511 | fusionAlg_B.Selector14.OBJ_Abs_Long_Velocity; |
| 27512 | fusionAlg_B.ObjList.vision_15_obj.obj_velocity.VxVariance = |
| 27513 | fusionAlg_B.Selector14.OBJ_Abs_Long_Velocity_STD; |
| 27514 | fusionAlg_B.ObjList.vision_15_obj.obj_velocity.Vy = |
| 27515 | fusionAlg_B.Selector14.OBJ_Abs_Lat_Velocity; |
| 27516 | fusionAlg_B.ObjList.vision_15_obj.obj_velocity.VyVariance = |
| 27517 | fusionAlg_B.Selector14.OBJ_Abs_Lat_Velocity_STD; |
| 27518 | |
| 27519 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' */ |
| 27520 | fusionAlg_B.ObjList.vision_15_obj.obj_angleOfCenter.centerAngle = |
| 27521 | fusionAlg_B.Selector14.OBJ_Angle_Mid; |
| 27522 | fusionAlg_B.ObjList.vision_15_obj.obj_angleOfCenter.centerAngleVariance = |
| 27523 | fusionAlg_B.Selector14.OBJ_Angle_Mid_STD; |
| 27524 | |
| 27525 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' */ |
| 27526 | fusionAlg_B.ObjList.vision_15_obj.obj_acceleration.Ax = |
| 27527 | fusionAlg_B.Selector14.OBJ_Abs_Long_Acc; |
| 27528 | fusionAlg_B.ObjList.vision_15_obj.obj_acceleration.AxVariance = |
| 27529 | fusionAlg_B.Selector14.OBJ_Abs_Long_Acc_STD; |
| 27530 | fusionAlg_B.ObjList.vision_15_obj.obj_acceleration.Ay = |
| 27531 | fusionAlg_B.Selector14.OBJ_Abs_Lat_Acc; |
| 27532 | fusionAlg_B.ObjList.vision_15_obj.obj_acceleration.AyVariance = |
| 27533 | fusionAlg_B.Selector14.OBJ_Abs_Lat_Acc_STD; |
| 27534 | |
| 27535 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' */ |
| 27536 | fusionAlg_B.ObjList.vision_15_obj.AyVariance.length = |
| 27537 | fusionAlg_B.Selector14.OBJ_Length; |
| 27538 | fusionAlg_B.ObjList.vision_15_obj.AyVariance.width = |
| 27539 | fusionAlg_B.Selector14.OBJ_Width; |
| 27540 | fusionAlg_B.ObjList.vision_15_obj.AyVariance.height = |
| 27541 | fusionAlg_B.Selector14.OBJ_Height; |
| 27542 | |
| 27543 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' incorporates: |
| 27544 | * Constant: '<S347>/Constant1' |
| 27545 | * Constant: '<S347>/Constant2' |
| 27546 | * Constant: '<S347>/Constant3' |
| 27547 | */ |
| 27548 | fusionAlg_B.ObjList.vision_15_obj.reserved1.reserved0 = |
| 27549 | fusionAlg_P_g.Constant2_Value_an; |
| 27550 | fusionAlg_B.ObjList.vision_15_obj.reserved1.reserved1 = |
| 27551 | fusionAlg_P_g.Constant1_Value_hqx; |
| 27552 | fusionAlg_B.ObjList.vision_15_obj.reserved1.reserved2 = |
| 27553 | fusionAlg_P_g.Constant3_Value_cdk; |
| 27554 | |
| 27555 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' incorporates: |
| 27556 | * Constant: '<S348>/Constant5' |
| 27557 | * Constant: '<S348>/Constant6' |
| 27558 | */ |
| 27559 | fusionAlg_B.ObjList.vision_15_obj.reserved2.reserved0 = |
| 27560 | fusionAlg_P_g.Constant5_Value_a20; |
| 27561 | fusionAlg_B.ObjList.vision_15_obj.reserved2.reserved1 = |
| 27562 | fusionAlg_P_g.Constant6_Value_jdy; |
| 27563 | |
| 27564 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_14' incorporates: |
| 27565 | * Constant: '<S238>/Constant' |
| 27566 | * Constant: '<S238>/Constant1' |
| 27567 | * Constant: '<S238>/Constant2' |
| 27568 | * Constant: '<S238>/Constant3' |
| 27569 | * Constant: '<S238>/Constant4' |
| 27570 | */ |
| 27571 | fusionAlg_B.ObjList.vision_15_obj.obj_type = fusionAlg_B.Obj_Type_en; |
| 27572 | fusionAlg_B.ObjList.vision_15_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_de; |
| 27573 | fusionAlg_B.ObjList.vision_15_obj.obj_TTC = fusionAlg_B.Selector14.OBJ_Inv_TTC; |
| 27574 | fusionAlg_B.ObjList.vision_15_obj.obj_TTCVariance = |
| 27575 | fusionAlg_B.Selector14.OBJ_Inv_TTC_STD; |
| 27576 | fusionAlg_B.ObjList.vision_15_obj.obj_existProb = |
| 27577 | fusionAlg_P_g.Constant_Value_l; |
| 27578 | fusionAlg_B.ObjList.vision_15_obj.obj_angleOfObject = |
| 27579 | fusionAlg_P_g.Constant1_Value_pp; |
| 27580 | fusionAlg_B.ObjList.vision_15_obj.obj_Heading = |
| 27581 | fusionAlg_B.Selector14.OBJ_Heading; |
| 27582 | fusionAlg_B.ObjList.vision_15_obj.obj_Heading_STD = |
| 27583 | fusionAlg_P_g.Constant2_Value_lr; |
| 27584 | fusionAlg_B.ObjList.vision_15_obj.obj_Heading_V = |
| 27585 | fusionAlg_P_g.Constant3_Value_p4; |
| 27586 | fusionAlg_B.ObjList.vision_15_obj.obj_Heading_STD_V = |
| 27587 | fusionAlg_P_g.Constant4_Value_ltx; |
| 27588 | |
| 27589 | /* Selector: '<S223>/Selector15' incorporates: |
| 27590 | * Constant: '<S223>/Constant15' |
| 27591 | */ |
| 27592 | fusionAlg_B.Selector15 = rtu_EyeQ4_Info_st-> |
| 27593 | OBJ_BUS[fusionAlg_P_g.Constant15_Value_m]; |
| 27594 | |
| 27595 | /* DataTypeConversion: '<S239>/Data Type Conversion' */ |
| 27596 | tmp = (real32_T)floor(fusionAlg_B.Selector15.OBJ_ID); |
| 27597 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27598 | tmp = 0.0F; |
| 27599 | } else { |
| 27600 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27601 | } |
| 27602 | |
| 27603 | fusionAlg_B.ObjList.vision_16_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 27604 | (uint32_T)-tmp : (uint32_T)tmp; |
| 27605 | |
| 27606 | /* End of DataTypeConversion: '<S239>/Data Type Conversion' */ |
| 27607 | |
| 27608 | /* Lookup_n-D: '<S360>/1-D Lookup Table' */ |
| 27609 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector15.OBJ_Measuring_Status, |
| 27610 | fusionAlg_P_g.uDLookupTable_bp01Data_kh, 7U); |
| 27611 | fusionAlg_B.Obj_Status_cj = fusionAlg_P_g.uDLookupTable_tableData_bs[bpIdx]; |
| 27612 | |
| 27613 | /* DataTypeConversion: '<S360>/Data Type Conversion1' */ |
| 27614 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_cj); |
| 27615 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27616 | tmp = 0.0F; |
| 27617 | } else { |
| 27618 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27619 | } |
| 27620 | |
| 27621 | fusionAlg_B.ObjList.vision_16_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 27622 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 27623 | |
| 27624 | /* End of DataTypeConversion: '<S360>/Data Type Conversion1' */ |
| 27625 | |
| 27626 | /* DataTypeConversion: '<S351>/Data Type Conversion' */ |
| 27627 | tmp = (real32_T)floor(fusionAlg_B.Selector15.OBJ_Object_Age); |
| 27628 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27629 | tmp = 0.0F; |
| 27630 | } else { |
| 27631 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 27632 | } |
| 27633 | |
| 27634 | fusionAlg_B.measureAge_m4 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 27635 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 27636 | |
| 27637 | /* End of DataTypeConversion: '<S351>/Data Type Conversion' */ |
| 27638 | |
| 27639 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' incorporates: |
| 27640 | * Constant: '<S351>/Constant' |
| 27641 | * Constant: '<S351>/Constant1' |
| 27642 | */ |
| 27643 | fusionAlg_B.ObjList.vision_16_obj.obj_stageAge.totalAge = |
| 27644 | fusionAlg_B.measureAge_m4; |
| 27645 | fusionAlg_B.ObjList.vision_16_obj.obj_stageAge.initAge = |
| 27646 | fusionAlg_P_g.Constant_Value_ai; |
| 27647 | fusionAlg_B.ObjList.vision_16_obj.obj_stageAge.measureAge = |
| 27648 | fusionAlg_B.measureAge_m4; |
| 27649 | fusionAlg_B.ObjList.vision_16_obj.obj_stageAge.predictAge = |
| 27650 | fusionAlg_P_g.Constant1_Value_gs; |
| 27651 | |
| 27652 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' incorporates: |
| 27653 | * Constant: '<S352>/Constant' |
| 27654 | * Constant: '<S352>/Constant1' |
| 27655 | * Constant: '<S352>/Constant2' |
| 27656 | * Constant: '<S352>/Constant3' |
| 27657 | */ |
| 27658 | fusionAlg_B.ObjList.vision_16_obj.obj_boundary.X1 = |
| 27659 | fusionAlg_P_g.Constant_Value_lc; |
| 27660 | fusionAlg_B.ObjList.vision_16_obj.obj_boundary.Y1 = |
| 27661 | fusionAlg_P_g.Constant1_Value_lh; |
| 27662 | fusionAlg_B.ObjList.vision_16_obj.obj_boundary.X2 = |
| 27663 | fusionAlg_P_g.Constant2_Value_oq; |
| 27664 | fusionAlg_B.ObjList.vision_16_obj.obj_boundary.Y2 = |
| 27665 | fusionAlg_P_g.Constant3_Value_cb; |
| 27666 | |
| 27667 | /* Lookup_n-D: '<S361>/1-D Lookup Table' */ |
| 27668 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector15.OBJ_Object_Class, |
| 27669 | fusionAlg_P_g.uDLookupTable_bp01Data_o, 8U); |
| 27670 | fusionAlg_B.Obj_Status_ox = fusionAlg_P_g.uDLookupTable_tableData_hh[bpIdx]; |
| 27671 | |
| 27672 | /* DataTypeConversion: '<S361>/Data Type Conversion2' */ |
| 27673 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ox); |
| 27674 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27675 | tmp = 0.0F; |
| 27676 | } else { |
| 27677 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27678 | } |
| 27679 | |
| 27680 | fusionAlg_B.Obj_Type_mo = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27681 | (uint32_T)tmp; |
| 27682 | |
| 27683 | /* End of DataTypeConversion: '<S361>/Data Type Conversion2' */ |
| 27684 | |
| 27685 | /* DataTypeConversion: '<S239>/Data Type Conversion3' */ |
| 27686 | tmp = (real32_T)floor(fusionAlg_B.Selector15.OBJ_Class_Probability); |
| 27687 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27688 | tmp = 0.0F; |
| 27689 | } else { |
| 27690 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27691 | } |
| 27692 | |
| 27693 | fusionAlg_B.Obj_TypeConf_a5 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27694 | (uint32_T)tmp; |
| 27695 | |
| 27696 | /* End of DataTypeConversion: '<S239>/Data Type Conversion3' */ |
| 27697 | |
| 27698 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' */ |
| 27699 | fusionAlg_B.ObjList.vision_16_obj.obj_coordinate.lateral = |
| 27700 | fusionAlg_B.Selector15.OBJ_Lat_Distance; |
| 27701 | fusionAlg_B.ObjList.vision_16_obj.obj_coordinate.lateralVariance = |
| 27702 | fusionAlg_B.Selector15.OBJ_Lat_Distance_STD; |
| 27703 | fusionAlg_B.ObjList.vision_16_obj.obj_coordinate.longitudinal = |
| 27704 | fusionAlg_B.Selector15.OBJ_Long_Distance; |
| 27705 | fusionAlg_B.ObjList.vision_16_obj.obj_coordinate.longitudinalVariance = |
| 27706 | fusionAlg_B.Selector15.OBJ_Long_Distance_STD; |
| 27707 | |
| 27708 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' */ |
| 27709 | fusionAlg_B.ObjList.vision_16_obj.obj_velocity.Vx = |
| 27710 | fusionAlg_B.Selector15.OBJ_Abs_Long_Velocity; |
| 27711 | fusionAlg_B.ObjList.vision_16_obj.obj_velocity.VxVariance = |
| 27712 | fusionAlg_B.Selector15.OBJ_Abs_Long_Velocity_STD; |
| 27713 | fusionAlg_B.ObjList.vision_16_obj.obj_velocity.Vy = |
| 27714 | fusionAlg_B.Selector15.OBJ_Abs_Lat_Velocity; |
| 27715 | fusionAlg_B.ObjList.vision_16_obj.obj_velocity.VyVariance = |
| 27716 | fusionAlg_B.Selector15.OBJ_Abs_Lat_Velocity_STD; |
| 27717 | |
| 27718 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' */ |
| 27719 | fusionAlg_B.ObjList.vision_16_obj.obj_angleOfCenter.centerAngle = |
| 27720 | fusionAlg_B.Selector15.OBJ_Angle_Mid; |
| 27721 | fusionAlg_B.ObjList.vision_16_obj.obj_angleOfCenter.centerAngleVariance = |
| 27722 | fusionAlg_B.Selector15.OBJ_Angle_Mid_STD; |
| 27723 | |
| 27724 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' */ |
| 27725 | fusionAlg_B.ObjList.vision_16_obj.obj_acceleration.Ax = |
| 27726 | fusionAlg_B.Selector15.OBJ_Abs_Long_Acc; |
| 27727 | fusionAlg_B.ObjList.vision_16_obj.obj_acceleration.AxVariance = |
| 27728 | fusionAlg_B.Selector15.OBJ_Abs_Long_Acc_STD; |
| 27729 | fusionAlg_B.ObjList.vision_16_obj.obj_acceleration.Ay = |
| 27730 | fusionAlg_B.Selector15.OBJ_Abs_Lat_Acc; |
| 27731 | fusionAlg_B.ObjList.vision_16_obj.obj_acceleration.AyVariance = |
| 27732 | fusionAlg_B.Selector15.OBJ_Abs_Lat_Acc_STD; |
| 27733 | |
| 27734 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' */ |
| 27735 | fusionAlg_B.ObjList.vision_16_obj.AyVariance.length = |
| 27736 | fusionAlg_B.Selector15.OBJ_Length; |
| 27737 | fusionAlg_B.ObjList.vision_16_obj.AyVariance.width = |
| 27738 | fusionAlg_B.Selector15.OBJ_Width; |
| 27739 | fusionAlg_B.ObjList.vision_16_obj.AyVariance.height = |
| 27740 | fusionAlg_B.Selector15.OBJ_Height; |
| 27741 | |
| 27742 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' incorporates: |
| 27743 | * Constant: '<S358>/Constant1' |
| 27744 | * Constant: '<S358>/Constant2' |
| 27745 | * Constant: '<S358>/Constant3' |
| 27746 | */ |
| 27747 | fusionAlg_B.ObjList.vision_16_obj.reserved1.reserved0 = |
| 27748 | fusionAlg_P_g.Constant2_Value_ai; |
| 27749 | fusionAlg_B.ObjList.vision_16_obj.reserved1.reserved1 = |
| 27750 | fusionAlg_P_g.Constant1_Value_c2; |
| 27751 | fusionAlg_B.ObjList.vision_16_obj.reserved1.reserved2 = |
| 27752 | fusionAlg_P_g.Constant3_Value_kn; |
| 27753 | |
| 27754 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' incorporates: |
| 27755 | * Constant: '<S359>/Constant5' |
| 27756 | * Constant: '<S359>/Constant6' |
| 27757 | */ |
| 27758 | fusionAlg_B.ObjList.vision_16_obj.reserved2.reserved0 = |
| 27759 | fusionAlg_P_g.Constant5_Value_f5; |
| 27760 | fusionAlg_B.ObjList.vision_16_obj.reserved2.reserved1 = |
| 27761 | fusionAlg_P_g.Constant6_Value_pk; |
| 27762 | |
| 27763 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_15' incorporates: |
| 27764 | * Constant: '<S239>/Constant' |
| 27765 | * Constant: '<S239>/Constant1' |
| 27766 | * Constant: '<S239>/Constant2' |
| 27767 | * Constant: '<S239>/Constant3' |
| 27768 | * Constant: '<S239>/Constant4' |
| 27769 | */ |
| 27770 | fusionAlg_B.ObjList.vision_16_obj.obj_type = fusionAlg_B.Obj_Type_mo; |
| 27771 | fusionAlg_B.ObjList.vision_16_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_a5; |
| 27772 | fusionAlg_B.ObjList.vision_16_obj.obj_TTC = fusionAlg_B.Selector15.OBJ_Inv_TTC; |
| 27773 | fusionAlg_B.ObjList.vision_16_obj.obj_TTCVariance = |
| 27774 | fusionAlg_B.Selector15.OBJ_Inv_TTC_STD; |
| 27775 | fusionAlg_B.ObjList.vision_16_obj.obj_existProb = |
| 27776 | fusionAlg_P_g.Constant_Value_b4; |
| 27777 | fusionAlg_B.ObjList.vision_16_obj.obj_angleOfObject = |
| 27778 | fusionAlg_P_g.Constant1_Value_jz; |
| 27779 | fusionAlg_B.ObjList.vision_16_obj.obj_Heading = |
| 27780 | fusionAlg_B.Selector15.OBJ_Heading; |
| 27781 | fusionAlg_B.ObjList.vision_16_obj.obj_Heading_STD = |
| 27782 | fusionAlg_P_g.Constant2_Value_mb; |
| 27783 | fusionAlg_B.ObjList.vision_16_obj.obj_Heading_V = |
| 27784 | fusionAlg_P_g.Constant3_Value_jr; |
| 27785 | fusionAlg_B.ObjList.vision_16_obj.obj_Heading_STD_V = |
| 27786 | fusionAlg_P_g.Constant4_Value_pk; |
| 27787 | |
| 27788 | /* Selector: '<S223>/Selector16' incorporates: |
| 27789 | * Constant: '<S223>/Constant16' |
| 27790 | */ |
| 27791 | fusionAlg_B.Selector16 = rtu_EyeQ4_Info_st-> |
| 27792 | OBJ_BUS[fusionAlg_P_g.Constant16_Value_oy]; |
| 27793 | |
| 27794 | /* DataTypeConversion: '<S240>/Data Type Conversion' */ |
| 27795 | tmp = (real32_T)floor(fusionAlg_B.Selector16.OBJ_ID); |
| 27796 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27797 | tmp = 0.0F; |
| 27798 | } else { |
| 27799 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27800 | } |
| 27801 | |
| 27802 | fusionAlg_B.ObjList.vision_17_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 27803 | (uint32_T)-tmp : (uint32_T)tmp; |
| 27804 | |
| 27805 | /* End of DataTypeConversion: '<S240>/Data Type Conversion' */ |
| 27806 | |
| 27807 | /* Lookup_n-D: '<S371>/1-D Lookup Table' */ |
| 27808 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector16.OBJ_Measuring_Status, |
| 27809 | fusionAlg_P_g.uDLookupTable_bp01Data_fr, 7U); |
| 27810 | fusionAlg_B.Obj_Status_jy = fusionAlg_P_g.uDLookupTable_tableData_cw[bpIdx]; |
| 27811 | |
| 27812 | /* DataTypeConversion: '<S371>/Data Type Conversion1' */ |
| 27813 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_jy); |
| 27814 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27815 | tmp = 0.0F; |
| 27816 | } else { |
| 27817 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27818 | } |
| 27819 | |
| 27820 | fusionAlg_B.ObjList.vision_17_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 27821 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 27822 | |
| 27823 | /* End of DataTypeConversion: '<S371>/Data Type Conversion1' */ |
| 27824 | |
| 27825 | /* DataTypeConversion: '<S362>/Data Type Conversion' */ |
| 27826 | tmp = (real32_T)floor(fusionAlg_B.Selector16.OBJ_Object_Age); |
| 27827 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27828 | tmp = 0.0F; |
| 27829 | } else { |
| 27830 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 27831 | } |
| 27832 | |
| 27833 | fusionAlg_B.measureAge_em = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 27834 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 27835 | |
| 27836 | /* End of DataTypeConversion: '<S362>/Data Type Conversion' */ |
| 27837 | |
| 27838 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' incorporates: |
| 27839 | * Constant: '<S362>/Constant' |
| 27840 | * Constant: '<S362>/Constant1' |
| 27841 | */ |
| 27842 | fusionAlg_B.ObjList.vision_17_obj.obj_stageAge.totalAge = |
| 27843 | fusionAlg_B.measureAge_em; |
| 27844 | fusionAlg_B.ObjList.vision_17_obj.obj_stageAge.initAge = |
| 27845 | fusionAlg_P_g.Constant_Value_pz; |
| 27846 | fusionAlg_B.ObjList.vision_17_obj.obj_stageAge.measureAge = |
| 27847 | fusionAlg_B.measureAge_em; |
| 27848 | fusionAlg_B.ObjList.vision_17_obj.obj_stageAge.predictAge = |
| 27849 | fusionAlg_P_g.Constant1_Value_ae2; |
| 27850 | |
| 27851 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' incorporates: |
| 27852 | * Constant: '<S363>/Constant' |
| 27853 | * Constant: '<S363>/Constant1' |
| 27854 | * Constant: '<S363>/Constant2' |
| 27855 | * Constant: '<S363>/Constant3' |
| 27856 | */ |
| 27857 | fusionAlg_B.ObjList.vision_17_obj.obj_boundary.X1 = |
| 27858 | fusionAlg_P_g.Constant_Value_pa; |
| 27859 | fusionAlg_B.ObjList.vision_17_obj.obj_boundary.Y1 = |
| 27860 | fusionAlg_P_g.Constant1_Value_fy; |
| 27861 | fusionAlg_B.ObjList.vision_17_obj.obj_boundary.X2 = |
| 27862 | fusionAlg_P_g.Constant2_Value_j5; |
| 27863 | fusionAlg_B.ObjList.vision_17_obj.obj_boundary.Y2 = |
| 27864 | fusionAlg_P_g.Constant3_Value_mt; |
| 27865 | |
| 27866 | /* Lookup_n-D: '<S372>/1-D Lookup Table' */ |
| 27867 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector16.OBJ_Object_Class, |
| 27868 | fusionAlg_P_g.uDLookupTable_bp01Data_lw, 8U); |
| 27869 | fusionAlg_B.Obj_Status_az = fusionAlg_P_g.uDLookupTable_tableData_mv[bpIdx]; |
| 27870 | |
| 27871 | /* DataTypeConversion: '<S372>/Data Type Conversion2' */ |
| 27872 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_az); |
| 27873 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27874 | tmp = 0.0F; |
| 27875 | } else { |
| 27876 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27877 | } |
| 27878 | |
| 27879 | fusionAlg_B.Obj_Type_fo = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27880 | (uint32_T)tmp; |
| 27881 | |
| 27882 | /* End of DataTypeConversion: '<S372>/Data Type Conversion2' */ |
| 27883 | |
| 27884 | /* DataTypeConversion: '<S240>/Data Type Conversion3' */ |
| 27885 | tmp = (real32_T)floor(fusionAlg_B.Selector16.OBJ_Class_Probability); |
| 27886 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27887 | tmp = 0.0F; |
| 27888 | } else { |
| 27889 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27890 | } |
| 27891 | |
| 27892 | fusionAlg_B.Obj_TypeConf_bm = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 27893 | (uint32_T)tmp; |
| 27894 | |
| 27895 | /* End of DataTypeConversion: '<S240>/Data Type Conversion3' */ |
| 27896 | |
| 27897 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' */ |
| 27898 | fusionAlg_B.ObjList.vision_17_obj.obj_coordinate.lateral = |
| 27899 | fusionAlg_B.Selector16.OBJ_Lat_Distance; |
| 27900 | fusionAlg_B.ObjList.vision_17_obj.obj_coordinate.lateralVariance = |
| 27901 | fusionAlg_B.Selector16.OBJ_Lat_Distance_STD; |
| 27902 | fusionAlg_B.ObjList.vision_17_obj.obj_coordinate.longitudinal = |
| 27903 | fusionAlg_B.Selector16.OBJ_Long_Distance; |
| 27904 | fusionAlg_B.ObjList.vision_17_obj.obj_coordinate.longitudinalVariance = |
| 27905 | fusionAlg_B.Selector16.OBJ_Long_Distance_STD; |
| 27906 | |
| 27907 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' */ |
| 27908 | fusionAlg_B.ObjList.vision_17_obj.obj_velocity.Vx = |
| 27909 | fusionAlg_B.Selector16.OBJ_Abs_Long_Velocity; |
| 27910 | fusionAlg_B.ObjList.vision_17_obj.obj_velocity.VxVariance = |
| 27911 | fusionAlg_B.Selector16.OBJ_Abs_Long_Velocity_STD; |
| 27912 | fusionAlg_B.ObjList.vision_17_obj.obj_velocity.Vy = |
| 27913 | fusionAlg_B.Selector16.OBJ_Abs_Lat_Velocity; |
| 27914 | fusionAlg_B.ObjList.vision_17_obj.obj_velocity.VyVariance = |
| 27915 | fusionAlg_B.Selector16.OBJ_Abs_Lat_Velocity_STD; |
| 27916 | |
| 27917 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' */ |
| 27918 | fusionAlg_B.ObjList.vision_17_obj.obj_angleOfCenter.centerAngle = |
| 27919 | fusionAlg_B.Selector16.OBJ_Angle_Mid; |
| 27920 | fusionAlg_B.ObjList.vision_17_obj.obj_angleOfCenter.centerAngleVariance = |
| 27921 | fusionAlg_B.Selector16.OBJ_Angle_Mid_STD; |
| 27922 | |
| 27923 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' */ |
| 27924 | fusionAlg_B.ObjList.vision_17_obj.obj_acceleration.Ax = |
| 27925 | fusionAlg_B.Selector16.OBJ_Abs_Long_Acc; |
| 27926 | fusionAlg_B.ObjList.vision_17_obj.obj_acceleration.AxVariance = |
| 27927 | fusionAlg_B.Selector16.OBJ_Abs_Long_Acc_STD; |
| 27928 | fusionAlg_B.ObjList.vision_17_obj.obj_acceleration.Ay = |
| 27929 | fusionAlg_B.Selector16.OBJ_Abs_Lat_Acc; |
| 27930 | fusionAlg_B.ObjList.vision_17_obj.obj_acceleration.AyVariance = |
| 27931 | fusionAlg_B.Selector16.OBJ_Abs_Lat_Acc_STD; |
| 27932 | |
| 27933 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' */ |
| 27934 | fusionAlg_B.ObjList.vision_17_obj.AyVariance.length = |
| 27935 | fusionAlg_B.Selector16.OBJ_Length; |
| 27936 | fusionAlg_B.ObjList.vision_17_obj.AyVariance.width = |
| 27937 | fusionAlg_B.Selector16.OBJ_Width; |
| 27938 | fusionAlg_B.ObjList.vision_17_obj.AyVariance.height = |
| 27939 | fusionAlg_B.Selector16.OBJ_Height; |
| 27940 | |
| 27941 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' incorporates: |
| 27942 | * Constant: '<S369>/Constant1' |
| 27943 | * Constant: '<S369>/Constant2' |
| 27944 | * Constant: '<S369>/Constant3' |
| 27945 | */ |
| 27946 | fusionAlg_B.ObjList.vision_17_obj.reserved1.reserved0 = |
| 27947 | fusionAlg_P_g.Constant2_Value_ey; |
| 27948 | fusionAlg_B.ObjList.vision_17_obj.reserved1.reserved1 = |
| 27949 | fusionAlg_P_g.Constant1_Value_omj; |
| 27950 | fusionAlg_B.ObjList.vision_17_obj.reserved1.reserved2 = |
| 27951 | fusionAlg_P_g.Constant3_Value_mh; |
| 27952 | |
| 27953 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' incorporates: |
| 27954 | * Constant: '<S370>/Constant5' |
| 27955 | * Constant: '<S370>/Constant6' |
| 27956 | */ |
| 27957 | fusionAlg_B.ObjList.vision_17_obj.reserved2.reserved0 = |
| 27958 | fusionAlg_P_g.Constant5_Value_ee; |
| 27959 | fusionAlg_B.ObjList.vision_17_obj.reserved2.reserved1 = |
| 27960 | fusionAlg_P_g.Constant6_Value_gey; |
| 27961 | |
| 27962 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_16' incorporates: |
| 27963 | * Constant: '<S240>/Constant' |
| 27964 | * Constant: '<S240>/Constant1' |
| 27965 | * Constant: '<S240>/Constant2' |
| 27966 | * Constant: '<S240>/Constant3' |
| 27967 | * Constant: '<S240>/Constant4' |
| 27968 | */ |
| 27969 | fusionAlg_B.ObjList.vision_17_obj.obj_type = fusionAlg_B.Obj_Type_fo; |
| 27970 | fusionAlg_B.ObjList.vision_17_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_bm; |
| 27971 | fusionAlg_B.ObjList.vision_17_obj.obj_TTC = fusionAlg_B.Selector16.OBJ_Inv_TTC; |
| 27972 | fusionAlg_B.ObjList.vision_17_obj.obj_TTCVariance = |
| 27973 | fusionAlg_B.Selector16.OBJ_Inv_TTC_STD; |
| 27974 | fusionAlg_B.ObjList.vision_17_obj.obj_existProb = |
| 27975 | fusionAlg_P_g.Constant_Value_n; |
| 27976 | fusionAlg_B.ObjList.vision_17_obj.obj_angleOfObject = |
| 27977 | fusionAlg_P_g.Constant1_Value_ojg; |
| 27978 | fusionAlg_B.ObjList.vision_17_obj.obj_Heading = |
| 27979 | fusionAlg_B.Selector16.OBJ_Heading; |
| 27980 | fusionAlg_B.ObjList.vision_17_obj.obj_Heading_STD = |
| 27981 | fusionAlg_P_g.Constant2_Value_a3; |
| 27982 | fusionAlg_B.ObjList.vision_17_obj.obj_Heading_V = |
| 27983 | fusionAlg_P_g.Constant3_Value_cjb; |
| 27984 | fusionAlg_B.ObjList.vision_17_obj.obj_Heading_STD_V = |
| 27985 | fusionAlg_P_g.Constant4_Value_np; |
| 27986 | |
| 27987 | /* Selector: '<S223>/Selector24' incorporates: |
| 27988 | * Constant: '<S223>/Constant17' |
| 27989 | */ |
| 27990 | fusionAlg_B.Selector24 = rtu_EyeQ4_Info_st-> |
| 27991 | OBJ_BUS[fusionAlg_P_g.Constant17_Value_l]; |
| 27992 | |
| 27993 | /* DataTypeConversion: '<S241>/Data Type Conversion' */ |
| 27994 | tmp = (real32_T)floor(fusionAlg_B.Selector24.OBJ_ID); |
| 27995 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 27996 | tmp = 0.0F; |
| 27997 | } else { |
| 27998 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 27999 | } |
| 28000 | |
| 28001 | fusionAlg_B.ObjList.vision_18_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 28002 | (uint32_T)-tmp : (uint32_T)tmp; |
| 28003 | |
| 28004 | /* End of DataTypeConversion: '<S241>/Data Type Conversion' */ |
| 28005 | |
| 28006 | /* Lookup_n-D: '<S382>/1-D Lookup Table' */ |
| 28007 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector24.OBJ_Measuring_Status, |
| 28008 | fusionAlg_P_g.uDLookupTable_bp01Data_ks, 7U); |
| 28009 | fusionAlg_B.Obj_Status_hz = fusionAlg_P_g.uDLookupTable_tableData_lz[bpIdx]; |
| 28010 | |
| 28011 | /* DataTypeConversion: '<S382>/Data Type Conversion1' */ |
| 28012 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_hz); |
| 28013 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28014 | tmp = 0.0F; |
| 28015 | } else { |
| 28016 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28017 | } |
| 28018 | |
| 28019 | fusionAlg_B.ObjList.vision_18_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 28020 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 28021 | |
| 28022 | /* End of DataTypeConversion: '<S382>/Data Type Conversion1' */ |
| 28023 | |
| 28024 | /* DataTypeConversion: '<S373>/Data Type Conversion' */ |
| 28025 | tmp = (real32_T)floor(fusionAlg_B.Selector24.OBJ_Object_Age); |
| 28026 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28027 | tmp = 0.0F; |
| 28028 | } else { |
| 28029 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 28030 | } |
| 28031 | |
| 28032 | fusionAlg_B.measureAge_kk = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 28033 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 28034 | |
| 28035 | /* End of DataTypeConversion: '<S373>/Data Type Conversion' */ |
| 28036 | |
| 28037 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' incorporates: |
| 28038 | * Constant: '<S373>/Constant' |
| 28039 | * Constant: '<S373>/Constant1' |
| 28040 | */ |
| 28041 | fusionAlg_B.ObjList.vision_18_obj.obj_stageAge.totalAge = |
| 28042 | fusionAlg_B.measureAge_kk; |
| 28043 | fusionAlg_B.ObjList.vision_18_obj.obj_stageAge.initAge = |
| 28044 | fusionAlg_P_g.Constant_Value_ge; |
| 28045 | fusionAlg_B.ObjList.vision_18_obj.obj_stageAge.measureAge = |
| 28046 | fusionAlg_B.measureAge_kk; |
| 28047 | fusionAlg_B.ObjList.vision_18_obj.obj_stageAge.predictAge = |
| 28048 | fusionAlg_P_g.Constant1_Value_by; |
| 28049 | |
| 28050 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' incorporates: |
| 28051 | * Constant: '<S374>/Constant' |
| 28052 | * Constant: '<S374>/Constant1' |
| 28053 | * Constant: '<S374>/Constant2' |
| 28054 | * Constant: '<S374>/Constant3' |
| 28055 | */ |
| 28056 | fusionAlg_B.ObjList.vision_18_obj.obj_boundary.X1 = |
| 28057 | fusionAlg_P_g.Constant_Value_h5; |
| 28058 | fusionAlg_B.ObjList.vision_18_obj.obj_boundary.Y1 = |
| 28059 | fusionAlg_P_g.Constant1_Value_oh; |
| 28060 | fusionAlg_B.ObjList.vision_18_obj.obj_boundary.X2 = |
| 28061 | fusionAlg_P_g.Constant2_Value_fh; |
| 28062 | fusionAlg_B.ObjList.vision_18_obj.obj_boundary.Y2 = |
| 28063 | fusionAlg_P_g.Constant3_Value_mp; |
| 28064 | |
| 28065 | /* Lookup_n-D: '<S383>/1-D Lookup Table' */ |
| 28066 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector24.OBJ_Object_Class, |
| 28067 | fusionAlg_P_g.uDLookupTable_bp01Data_lf, 8U); |
| 28068 | fusionAlg_B.Obj_Status_ov = fusionAlg_P_g.uDLookupTable_tableData_jm[bpIdx]; |
| 28069 | |
| 28070 | /* DataTypeConversion: '<S383>/Data Type Conversion2' */ |
| 28071 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ov); |
| 28072 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28073 | tmp = 0.0F; |
| 28074 | } else { |
| 28075 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28076 | } |
| 28077 | |
| 28078 | fusionAlg_B.Obj_Type_n = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28079 | (uint32_T)tmp; |
| 28080 | |
| 28081 | /* End of DataTypeConversion: '<S383>/Data Type Conversion2' */ |
| 28082 | |
| 28083 | /* DataTypeConversion: '<S241>/Data Type Conversion3' */ |
| 28084 | tmp = (real32_T)floor(fusionAlg_B.Selector24.OBJ_Class_Probability); |
| 28085 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28086 | tmp = 0.0F; |
| 28087 | } else { |
| 28088 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28089 | } |
| 28090 | |
| 28091 | fusionAlg_B.Obj_TypeConf_n2 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28092 | (uint32_T)tmp; |
| 28093 | |
| 28094 | /* End of DataTypeConversion: '<S241>/Data Type Conversion3' */ |
| 28095 | |
| 28096 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' */ |
| 28097 | fusionAlg_B.ObjList.vision_18_obj.obj_coordinate.lateral = |
| 28098 | fusionAlg_B.Selector24.OBJ_Lat_Distance; |
| 28099 | fusionAlg_B.ObjList.vision_18_obj.obj_coordinate.lateralVariance = |
| 28100 | fusionAlg_B.Selector24.OBJ_Lat_Distance_STD; |
| 28101 | fusionAlg_B.ObjList.vision_18_obj.obj_coordinate.longitudinal = |
| 28102 | fusionAlg_B.Selector24.OBJ_Long_Distance; |
| 28103 | fusionAlg_B.ObjList.vision_18_obj.obj_coordinate.longitudinalVariance = |
| 28104 | fusionAlg_B.Selector24.OBJ_Long_Distance_STD; |
| 28105 | |
| 28106 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' */ |
| 28107 | fusionAlg_B.ObjList.vision_18_obj.obj_velocity.Vx = |
| 28108 | fusionAlg_B.Selector24.OBJ_Abs_Long_Velocity; |
| 28109 | fusionAlg_B.ObjList.vision_18_obj.obj_velocity.VxVariance = |
| 28110 | fusionAlg_B.Selector24.OBJ_Abs_Long_Velocity_STD; |
| 28111 | fusionAlg_B.ObjList.vision_18_obj.obj_velocity.Vy = |
| 28112 | fusionAlg_B.Selector24.OBJ_Abs_Lat_Velocity; |
| 28113 | fusionAlg_B.ObjList.vision_18_obj.obj_velocity.VyVariance = |
| 28114 | fusionAlg_B.Selector24.OBJ_Abs_Lat_Velocity_STD; |
| 28115 | |
| 28116 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' */ |
| 28117 | fusionAlg_B.ObjList.vision_18_obj.obj_angleOfCenter.centerAngle = |
| 28118 | fusionAlg_B.Selector24.OBJ_Angle_Mid; |
| 28119 | fusionAlg_B.ObjList.vision_18_obj.obj_angleOfCenter.centerAngleVariance = |
| 28120 | fusionAlg_B.Selector24.OBJ_Angle_Mid_STD; |
| 28121 | |
| 28122 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' */ |
| 28123 | fusionAlg_B.ObjList.vision_18_obj.obj_acceleration.Ax = |
| 28124 | fusionAlg_B.Selector24.OBJ_Abs_Long_Acc; |
| 28125 | fusionAlg_B.ObjList.vision_18_obj.obj_acceleration.AxVariance = |
| 28126 | fusionAlg_B.Selector24.OBJ_Abs_Long_Acc_STD; |
| 28127 | fusionAlg_B.ObjList.vision_18_obj.obj_acceleration.Ay = |
| 28128 | fusionAlg_B.Selector24.OBJ_Abs_Lat_Acc; |
| 28129 | fusionAlg_B.ObjList.vision_18_obj.obj_acceleration.AyVariance = |
| 28130 | fusionAlg_B.Selector24.OBJ_Abs_Lat_Acc_STD; |
| 28131 | |
| 28132 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' */ |
| 28133 | fusionAlg_B.ObjList.vision_18_obj.AyVariance.length = |
| 28134 | fusionAlg_B.Selector24.OBJ_Length; |
| 28135 | fusionAlg_B.ObjList.vision_18_obj.AyVariance.width = |
| 28136 | fusionAlg_B.Selector24.OBJ_Width; |
| 28137 | fusionAlg_B.ObjList.vision_18_obj.AyVariance.height = |
| 28138 | fusionAlg_B.Selector24.OBJ_Height; |
| 28139 | |
| 28140 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' incorporates: |
| 28141 | * Constant: '<S380>/Constant1' |
| 28142 | * Constant: '<S380>/Constant2' |
| 28143 | * Constant: '<S380>/Constant3' |
| 28144 | */ |
| 28145 | fusionAlg_B.ObjList.vision_18_obj.reserved1.reserved0 = |
| 28146 | fusionAlg_P_g.Constant2_Value_dp; |
| 28147 | fusionAlg_B.ObjList.vision_18_obj.reserved1.reserved1 = |
| 28148 | fusionAlg_P_g.Constant1_Value_jeq; |
| 28149 | fusionAlg_B.ObjList.vision_18_obj.reserved1.reserved2 = |
| 28150 | fusionAlg_P_g.Constant3_Value_gh; |
| 28151 | |
| 28152 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' incorporates: |
| 28153 | * Constant: '<S381>/Constant5' |
| 28154 | * Constant: '<S381>/Constant6' |
| 28155 | */ |
| 28156 | fusionAlg_B.ObjList.vision_18_obj.reserved2.reserved0 = |
| 28157 | fusionAlg_P_g.Constant5_Value_fg; |
| 28158 | fusionAlg_B.ObjList.vision_18_obj.reserved2.reserved1 = |
| 28159 | fusionAlg_P_g.Constant6_Value_ko; |
| 28160 | |
| 28161 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_17' incorporates: |
| 28162 | * Constant: '<S241>/Constant' |
| 28163 | * Constant: '<S241>/Constant1' |
| 28164 | * Constant: '<S241>/Constant2' |
| 28165 | * Constant: '<S241>/Constant3' |
| 28166 | * Constant: '<S241>/Constant4' |
| 28167 | */ |
| 28168 | fusionAlg_B.ObjList.vision_18_obj.obj_type = fusionAlg_B.Obj_Type_n; |
| 28169 | fusionAlg_B.ObjList.vision_18_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_n2; |
| 28170 | fusionAlg_B.ObjList.vision_18_obj.obj_TTC = fusionAlg_B.Selector24.OBJ_Inv_TTC; |
| 28171 | fusionAlg_B.ObjList.vision_18_obj.obj_TTCVariance = |
| 28172 | fusionAlg_B.Selector24.OBJ_Inv_TTC_STD; |
| 28173 | fusionAlg_B.ObjList.vision_18_obj.obj_existProb = |
| 28174 | fusionAlg_P_g.Constant_Value_aa; |
| 28175 | fusionAlg_B.ObjList.vision_18_obj.obj_angleOfObject = |
| 28176 | fusionAlg_P_g.Constant1_Value_p4; |
| 28177 | fusionAlg_B.ObjList.vision_18_obj.obj_Heading = |
| 28178 | fusionAlg_B.Selector24.OBJ_Heading; |
| 28179 | fusionAlg_B.ObjList.vision_18_obj.obj_Heading_STD = |
| 28180 | fusionAlg_P_g.Constant2_Value_njq; |
| 28181 | fusionAlg_B.ObjList.vision_18_obj.obj_Heading_V = |
| 28182 | fusionAlg_P_g.Constant3_Value_er; |
| 28183 | fusionAlg_B.ObjList.vision_18_obj.obj_Heading_STD_V = |
| 28184 | fusionAlg_P_g.Constant4_Value_du0; |
| 28185 | |
| 28186 | /* Selector: '<S223>/Selector25' incorporates: |
| 28187 | * Constant: '<S223>/Constant18' |
| 28188 | */ |
| 28189 | fusionAlg_B.Selector25 = rtu_EyeQ4_Info_st-> |
| 28190 | OBJ_BUS[fusionAlg_P_g.Constant18_Value_p]; |
| 28191 | |
| 28192 | /* DataTypeConversion: '<S242>/Data Type Conversion' */ |
| 28193 | tmp = (real32_T)floor(fusionAlg_B.Selector25.OBJ_ID); |
| 28194 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28195 | tmp = 0.0F; |
| 28196 | } else { |
| 28197 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28198 | } |
| 28199 | |
| 28200 | fusionAlg_B.ObjList.vision_19_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 28201 | (uint32_T)-tmp : (uint32_T)tmp; |
| 28202 | |
| 28203 | /* End of DataTypeConversion: '<S242>/Data Type Conversion' */ |
| 28204 | |
| 28205 | /* Lookup_n-D: '<S393>/1-D Lookup Table' */ |
| 28206 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector25.OBJ_Measuring_Status, |
| 28207 | fusionAlg_P_g.uDLookupTable_bp01Data_b, 7U); |
| 28208 | fusionAlg_B.Obj_Status_mi = fusionAlg_P_g.uDLookupTable_tableData_fo[bpIdx]; |
| 28209 | |
| 28210 | /* DataTypeConversion: '<S393>/Data Type Conversion1' */ |
| 28211 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_mi); |
| 28212 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28213 | tmp = 0.0F; |
| 28214 | } else { |
| 28215 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28216 | } |
| 28217 | |
| 28218 | fusionAlg_B.ObjList.vision_19_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 28219 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 28220 | |
| 28221 | /* End of DataTypeConversion: '<S393>/Data Type Conversion1' */ |
| 28222 | |
| 28223 | /* DataTypeConversion: '<S384>/Data Type Conversion' */ |
| 28224 | tmp = (real32_T)floor(fusionAlg_B.Selector25.OBJ_Object_Age); |
| 28225 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28226 | tmp = 0.0F; |
| 28227 | } else { |
| 28228 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 28229 | } |
| 28230 | |
| 28231 | fusionAlg_B.measureAge_f = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 28232 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 28233 | |
| 28234 | /* End of DataTypeConversion: '<S384>/Data Type Conversion' */ |
| 28235 | |
| 28236 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' incorporates: |
| 28237 | * Constant: '<S384>/Constant' |
| 28238 | * Constant: '<S384>/Constant1' |
| 28239 | */ |
| 28240 | fusionAlg_B.ObjList.vision_19_obj.obj_stageAge.totalAge = |
| 28241 | fusionAlg_B.measureAge_f; |
| 28242 | fusionAlg_B.ObjList.vision_19_obj.obj_stageAge.initAge = |
| 28243 | fusionAlg_P_g.Constant_Value_kv; |
| 28244 | fusionAlg_B.ObjList.vision_19_obj.obj_stageAge.measureAge = |
| 28245 | fusionAlg_B.measureAge_f; |
| 28246 | fusionAlg_B.ObjList.vision_19_obj.obj_stageAge.predictAge = |
| 28247 | fusionAlg_P_g.Constant1_Value_fp; |
| 28248 | |
| 28249 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' incorporates: |
| 28250 | * Constant: '<S385>/Constant' |
| 28251 | * Constant: '<S385>/Constant1' |
| 28252 | * Constant: '<S385>/Constant2' |
| 28253 | * Constant: '<S385>/Constant3' |
| 28254 | */ |
| 28255 | fusionAlg_B.ObjList.vision_19_obj.obj_boundary.X1 = |
| 28256 | fusionAlg_P_g.Constant_Value_f3; |
| 28257 | fusionAlg_B.ObjList.vision_19_obj.obj_boundary.Y1 = |
| 28258 | fusionAlg_P_g.Constant1_Value_gc; |
| 28259 | fusionAlg_B.ObjList.vision_19_obj.obj_boundary.X2 = |
| 28260 | fusionAlg_P_g.Constant2_Value_bl; |
| 28261 | fusionAlg_B.ObjList.vision_19_obj.obj_boundary.Y2 = |
| 28262 | fusionAlg_P_g.Constant3_Value_eb; |
| 28263 | |
| 28264 | /* Lookup_n-D: '<S394>/1-D Lookup Table' */ |
| 28265 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector25.OBJ_Object_Class, |
| 28266 | fusionAlg_P_g.uDLookupTable_bp01Data_im, 8U); |
| 28267 | fusionAlg_B.Obj_Status_p0 = fusionAlg_P_g.uDLookupTable_tableData_ht[bpIdx]; |
| 28268 | |
| 28269 | /* DataTypeConversion: '<S394>/Data Type Conversion2' */ |
| 28270 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_p0); |
| 28271 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28272 | tmp = 0.0F; |
| 28273 | } else { |
| 28274 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28275 | } |
| 28276 | |
| 28277 | fusionAlg_B.Obj_Type_g = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28278 | (uint32_T)tmp; |
| 28279 | |
| 28280 | /* End of DataTypeConversion: '<S394>/Data Type Conversion2' */ |
| 28281 | |
| 28282 | /* DataTypeConversion: '<S242>/Data Type Conversion3' */ |
| 28283 | tmp = (real32_T)floor(fusionAlg_B.Selector25.OBJ_Class_Probability); |
| 28284 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28285 | tmp = 0.0F; |
| 28286 | } else { |
| 28287 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28288 | } |
| 28289 | |
| 28290 | fusionAlg_B.Obj_TypeConf_l = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28291 | (uint32_T)tmp; |
| 28292 | |
| 28293 | /* End of DataTypeConversion: '<S242>/Data Type Conversion3' */ |
| 28294 | |
| 28295 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' */ |
| 28296 | fusionAlg_B.ObjList.vision_19_obj.obj_coordinate.lateral = |
| 28297 | fusionAlg_B.Selector25.OBJ_Lat_Distance; |
| 28298 | fusionAlg_B.ObjList.vision_19_obj.obj_coordinate.lateralVariance = |
| 28299 | fusionAlg_B.Selector25.OBJ_Lat_Distance_STD; |
| 28300 | fusionAlg_B.ObjList.vision_19_obj.obj_coordinate.longitudinal = |
| 28301 | fusionAlg_B.Selector25.OBJ_Long_Distance; |
| 28302 | fusionAlg_B.ObjList.vision_19_obj.obj_coordinate.longitudinalVariance = |
| 28303 | fusionAlg_B.Selector25.OBJ_Long_Distance_STD; |
| 28304 | |
| 28305 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' */ |
| 28306 | fusionAlg_B.ObjList.vision_19_obj.obj_velocity.Vx = |
| 28307 | fusionAlg_B.Selector25.OBJ_Abs_Long_Velocity; |
| 28308 | fusionAlg_B.ObjList.vision_19_obj.obj_velocity.VxVariance = |
| 28309 | fusionAlg_B.Selector25.OBJ_Abs_Long_Velocity_STD; |
| 28310 | fusionAlg_B.ObjList.vision_19_obj.obj_velocity.Vy = |
| 28311 | fusionAlg_B.Selector25.OBJ_Abs_Lat_Velocity; |
| 28312 | fusionAlg_B.ObjList.vision_19_obj.obj_velocity.VyVariance = |
| 28313 | fusionAlg_B.Selector25.OBJ_Abs_Lat_Velocity_STD; |
| 28314 | |
| 28315 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' */ |
| 28316 | fusionAlg_B.ObjList.vision_19_obj.obj_angleOfCenter.centerAngle = |
| 28317 | fusionAlg_B.Selector25.OBJ_Angle_Mid; |
| 28318 | fusionAlg_B.ObjList.vision_19_obj.obj_angleOfCenter.centerAngleVariance = |
| 28319 | fusionAlg_B.Selector25.OBJ_Angle_Mid_STD; |
| 28320 | |
| 28321 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' */ |
| 28322 | fusionAlg_B.ObjList.vision_19_obj.obj_acceleration.Ax = |
| 28323 | fusionAlg_B.Selector25.OBJ_Abs_Long_Acc; |
| 28324 | fusionAlg_B.ObjList.vision_19_obj.obj_acceleration.AxVariance = |
| 28325 | fusionAlg_B.Selector25.OBJ_Abs_Long_Acc_STD; |
| 28326 | fusionAlg_B.ObjList.vision_19_obj.obj_acceleration.Ay = |
| 28327 | fusionAlg_B.Selector25.OBJ_Abs_Lat_Acc; |
| 28328 | fusionAlg_B.ObjList.vision_19_obj.obj_acceleration.AyVariance = |
| 28329 | fusionAlg_B.Selector25.OBJ_Abs_Lat_Acc_STD; |
| 28330 | |
| 28331 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' */ |
| 28332 | fusionAlg_B.ObjList.vision_19_obj.AyVariance.length = |
| 28333 | fusionAlg_B.Selector25.OBJ_Length; |
| 28334 | fusionAlg_B.ObjList.vision_19_obj.AyVariance.width = |
| 28335 | fusionAlg_B.Selector25.OBJ_Width; |
| 28336 | fusionAlg_B.ObjList.vision_19_obj.AyVariance.height = |
| 28337 | fusionAlg_B.Selector25.OBJ_Height; |
| 28338 | |
| 28339 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' incorporates: |
| 28340 | * Constant: '<S391>/Constant1' |
| 28341 | * Constant: '<S391>/Constant2' |
| 28342 | * Constant: '<S391>/Constant3' |
| 28343 | */ |
| 28344 | fusionAlg_B.ObjList.vision_19_obj.reserved1.reserved0 = |
| 28345 | fusionAlg_P_g.Constant2_Value_cz; |
| 28346 | fusionAlg_B.ObjList.vision_19_obj.reserved1.reserved1 = |
| 28347 | fusionAlg_P_g.Constant1_Value_bzq; |
| 28348 | fusionAlg_B.ObjList.vision_19_obj.reserved1.reserved2 = |
| 28349 | fusionAlg_P_g.Constant3_Value_fy; |
| 28350 | |
| 28351 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' incorporates: |
| 28352 | * Constant: '<S392>/Constant5' |
| 28353 | * Constant: '<S392>/Constant6' |
| 28354 | */ |
| 28355 | fusionAlg_B.ObjList.vision_19_obj.reserved2.reserved0 = |
| 28356 | fusionAlg_P_g.Constant5_Value_jn; |
| 28357 | fusionAlg_B.ObjList.vision_19_obj.reserved2.reserved1 = |
| 28358 | fusionAlg_P_g.Constant6_Value_cr; |
| 28359 | |
| 28360 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_18' incorporates: |
| 28361 | * Constant: '<S242>/Constant' |
| 28362 | * Constant: '<S242>/Constant1' |
| 28363 | * Constant: '<S242>/Constant2' |
| 28364 | * Constant: '<S242>/Constant3' |
| 28365 | * Constant: '<S242>/Constant4' |
| 28366 | */ |
| 28367 | fusionAlg_B.ObjList.vision_19_obj.obj_type = fusionAlg_B.Obj_Type_g; |
| 28368 | fusionAlg_B.ObjList.vision_19_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_l; |
| 28369 | fusionAlg_B.ObjList.vision_19_obj.obj_TTC = fusionAlg_B.Selector25.OBJ_Inv_TTC; |
| 28370 | fusionAlg_B.ObjList.vision_19_obj.obj_TTCVariance = |
| 28371 | fusionAlg_B.Selector25.OBJ_Inv_TTC_STD; |
| 28372 | fusionAlg_B.ObjList.vision_19_obj.obj_existProb = |
| 28373 | fusionAlg_P_g.Constant_Value_m; |
| 28374 | fusionAlg_B.ObjList.vision_19_obj.obj_angleOfObject = |
| 28375 | fusionAlg_P_g.Constant1_Value_ikr; |
| 28376 | fusionAlg_B.ObjList.vision_19_obj.obj_Heading = |
| 28377 | fusionAlg_B.Selector25.OBJ_Heading; |
| 28378 | fusionAlg_B.ObjList.vision_19_obj.obj_Heading_STD = |
| 28379 | fusionAlg_P_g.Constant2_Value_bp; |
| 28380 | fusionAlg_B.ObjList.vision_19_obj.obj_Heading_V = |
| 28381 | fusionAlg_P_g.Constant3_Value_nw; |
| 28382 | fusionAlg_B.ObjList.vision_19_obj.obj_Heading_STD_V = |
| 28383 | fusionAlg_P_g.Constant4_Value_m4; |
| 28384 | |
| 28385 | /* Selector: '<S223>/Selector26' incorporates: |
| 28386 | * Constant: '<S223>/Constant19' |
| 28387 | */ |
| 28388 | fusionAlg_B.Selector26 = rtu_EyeQ4_Info_st-> |
| 28389 | OBJ_BUS[fusionAlg_P_g.Constant19_Value_i]; |
| 28390 | |
| 28391 | /* DataTypeConversion: '<S244>/Data Type Conversion' */ |
| 28392 | tmp = (real32_T)floor(fusionAlg_B.Selector26.OBJ_ID); |
| 28393 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28394 | tmp = 0.0F; |
| 28395 | } else { |
| 28396 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28397 | } |
| 28398 | |
| 28399 | fusionAlg_B.ObjList.vision_20_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 28400 | (uint32_T)-tmp : (uint32_T)tmp; |
| 28401 | |
| 28402 | /* End of DataTypeConversion: '<S244>/Data Type Conversion' */ |
| 28403 | |
| 28404 | /* Lookup_n-D: '<S415>/1-D Lookup Table' */ |
| 28405 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector26.OBJ_Measuring_Status, |
| 28406 | fusionAlg_P_g.uDLookupTable_bp01Data_bt, 7U); |
| 28407 | fusionAlg_B.Obj_Status_mia = fusionAlg_P_g.uDLookupTable_tableData_ba[bpIdx]; |
| 28408 | |
| 28409 | /* DataTypeConversion: '<S415>/Data Type Conversion1' */ |
| 28410 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_mia); |
| 28411 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28412 | tmp = 0.0F; |
| 28413 | } else { |
| 28414 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28415 | } |
| 28416 | |
| 28417 | fusionAlg_B.ObjList.vision_20_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 28418 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 28419 | |
| 28420 | /* End of DataTypeConversion: '<S415>/Data Type Conversion1' */ |
| 28421 | |
| 28422 | /* DataTypeConversion: '<S406>/Data Type Conversion' */ |
| 28423 | tmp = (real32_T)floor(fusionAlg_B.Selector26.OBJ_Object_Age); |
| 28424 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28425 | tmp = 0.0F; |
| 28426 | } else { |
| 28427 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 28428 | } |
| 28429 | |
| 28430 | fusionAlg_B.measureAge_d = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 28431 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 28432 | |
| 28433 | /* End of DataTypeConversion: '<S406>/Data Type Conversion' */ |
| 28434 | |
| 28435 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' incorporates: |
| 28436 | * Constant: '<S406>/Constant' |
| 28437 | * Constant: '<S406>/Constant1' |
| 28438 | */ |
| 28439 | fusionAlg_B.ObjList.vision_20_obj.obj_stageAge.totalAge = |
| 28440 | fusionAlg_B.measureAge_d; |
| 28441 | fusionAlg_B.ObjList.vision_20_obj.obj_stageAge.initAge = |
| 28442 | fusionAlg_P_g.Constant_Value_bx; |
| 28443 | fusionAlg_B.ObjList.vision_20_obj.obj_stageAge.measureAge = |
| 28444 | fusionAlg_B.measureAge_d; |
| 28445 | fusionAlg_B.ObjList.vision_20_obj.obj_stageAge.predictAge = |
| 28446 | fusionAlg_P_g.Constant1_Value_ne; |
| 28447 | |
| 28448 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' incorporates: |
| 28449 | * Constant: '<S407>/Constant' |
| 28450 | * Constant: '<S407>/Constant1' |
| 28451 | * Constant: '<S407>/Constant2' |
| 28452 | * Constant: '<S407>/Constant3' |
| 28453 | */ |
| 28454 | fusionAlg_B.ObjList.vision_20_obj.obj_boundary.X1 = |
| 28455 | fusionAlg_P_g.Constant_Value_o55; |
| 28456 | fusionAlg_B.ObjList.vision_20_obj.obj_boundary.Y1 = |
| 28457 | fusionAlg_P_g.Constant1_Value_k; |
| 28458 | fusionAlg_B.ObjList.vision_20_obj.obj_boundary.X2 = |
| 28459 | fusionAlg_P_g.Constant2_Value_m4; |
| 28460 | fusionAlg_B.ObjList.vision_20_obj.obj_boundary.Y2 = |
| 28461 | fusionAlg_P_g.Constant3_Value_l5e; |
| 28462 | |
| 28463 | /* Lookup_n-D: '<S416>/1-D Lookup Table' */ |
| 28464 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector26.OBJ_Object_Class, |
| 28465 | fusionAlg_P_g.uDLookupTable_bp01Data_hhb, 8U); |
| 28466 | fusionAlg_B.Obj_Status_ca = fusionAlg_P_g.uDLookupTable_tableData_od[bpIdx]; |
| 28467 | |
| 28468 | /* DataTypeConversion: '<S416>/Data Type Conversion2' */ |
| 28469 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ca); |
| 28470 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28471 | tmp = 0.0F; |
| 28472 | } else { |
| 28473 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28474 | } |
| 28475 | |
| 28476 | fusionAlg_B.Obj_Type_eu = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28477 | (uint32_T)tmp; |
| 28478 | |
| 28479 | /* End of DataTypeConversion: '<S416>/Data Type Conversion2' */ |
| 28480 | |
| 28481 | /* DataTypeConversion: '<S244>/Data Type Conversion3' */ |
| 28482 | tmp = (real32_T)floor(fusionAlg_B.Selector26.OBJ_Class_Probability); |
| 28483 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28484 | tmp = 0.0F; |
| 28485 | } else { |
| 28486 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28487 | } |
| 28488 | |
| 28489 | fusionAlg_B.Obj_TypeConf_o = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28490 | (uint32_T)tmp; |
| 28491 | |
| 28492 | /* End of DataTypeConversion: '<S244>/Data Type Conversion3' */ |
| 28493 | |
| 28494 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' */ |
| 28495 | fusionAlg_B.ObjList.vision_20_obj.obj_coordinate.lateral = |
| 28496 | fusionAlg_B.Selector26.OBJ_Lat_Distance; |
| 28497 | fusionAlg_B.ObjList.vision_20_obj.obj_coordinate.lateralVariance = |
| 28498 | fusionAlg_B.Selector26.OBJ_Lat_Distance_STD; |
| 28499 | fusionAlg_B.ObjList.vision_20_obj.obj_coordinate.longitudinal = |
| 28500 | fusionAlg_B.Selector26.OBJ_Long_Distance; |
| 28501 | fusionAlg_B.ObjList.vision_20_obj.obj_coordinate.longitudinalVariance = |
| 28502 | fusionAlg_B.Selector26.OBJ_Long_Distance_STD; |
| 28503 | |
| 28504 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' */ |
| 28505 | fusionAlg_B.ObjList.vision_20_obj.obj_velocity.Vx = |
| 28506 | fusionAlg_B.Selector26.OBJ_Abs_Long_Velocity; |
| 28507 | fusionAlg_B.ObjList.vision_20_obj.obj_velocity.VxVariance = |
| 28508 | fusionAlg_B.Selector26.OBJ_Abs_Long_Velocity_STD; |
| 28509 | fusionAlg_B.ObjList.vision_20_obj.obj_velocity.Vy = |
| 28510 | fusionAlg_B.Selector26.OBJ_Abs_Lat_Velocity; |
| 28511 | fusionAlg_B.ObjList.vision_20_obj.obj_velocity.VyVariance = |
| 28512 | fusionAlg_B.Selector26.OBJ_Abs_Lat_Velocity_STD; |
| 28513 | |
| 28514 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' */ |
| 28515 | fusionAlg_B.ObjList.vision_20_obj.obj_angleOfCenter.centerAngle = |
| 28516 | fusionAlg_B.Selector26.OBJ_Angle_Mid; |
| 28517 | fusionAlg_B.ObjList.vision_20_obj.obj_angleOfCenter.centerAngleVariance = |
| 28518 | fusionAlg_B.Selector26.OBJ_Angle_Mid_STD; |
| 28519 | |
| 28520 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' */ |
| 28521 | fusionAlg_B.ObjList.vision_20_obj.obj_acceleration.Ax = |
| 28522 | fusionAlg_B.Selector26.OBJ_Abs_Long_Acc; |
| 28523 | fusionAlg_B.ObjList.vision_20_obj.obj_acceleration.AxVariance = |
| 28524 | fusionAlg_B.Selector26.OBJ_Abs_Long_Acc_STD; |
| 28525 | fusionAlg_B.ObjList.vision_20_obj.obj_acceleration.Ay = |
| 28526 | fusionAlg_B.Selector26.OBJ_Abs_Lat_Acc; |
| 28527 | fusionAlg_B.ObjList.vision_20_obj.obj_acceleration.AyVariance = |
| 28528 | fusionAlg_B.Selector26.OBJ_Abs_Lat_Acc_STD; |
| 28529 | |
| 28530 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' */ |
| 28531 | fusionAlg_B.ObjList.vision_20_obj.AyVariance.length = |
| 28532 | fusionAlg_B.Selector26.OBJ_Length; |
| 28533 | fusionAlg_B.ObjList.vision_20_obj.AyVariance.width = |
| 28534 | fusionAlg_B.Selector26.OBJ_Width; |
| 28535 | fusionAlg_B.ObjList.vision_20_obj.AyVariance.height = |
| 28536 | fusionAlg_B.Selector26.OBJ_Height; |
| 28537 | |
| 28538 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' incorporates: |
| 28539 | * Constant: '<S413>/Constant1' |
| 28540 | * Constant: '<S413>/Constant2' |
| 28541 | * Constant: '<S413>/Constant3' |
| 28542 | */ |
| 28543 | fusionAlg_B.ObjList.vision_20_obj.reserved1.reserved0 = |
| 28544 | fusionAlg_P_g.Constant2_Value_jl; |
| 28545 | fusionAlg_B.ObjList.vision_20_obj.reserved1.reserved1 = |
| 28546 | fusionAlg_P_g.Constant1_Value_fvx; |
| 28547 | fusionAlg_B.ObjList.vision_20_obj.reserved1.reserved2 = |
| 28548 | fusionAlg_P_g.Constant3_Value_pq; |
| 28549 | |
| 28550 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' incorporates: |
| 28551 | * Constant: '<S414>/Constant5' |
| 28552 | * Constant: '<S414>/Constant6' |
| 28553 | */ |
| 28554 | fusionAlg_B.ObjList.vision_20_obj.reserved2.reserved0 = |
| 28555 | fusionAlg_P_g.Constant5_Value_kt; |
| 28556 | fusionAlg_B.ObjList.vision_20_obj.reserved2.reserved1 = |
| 28557 | fusionAlg_P_g.Constant6_Value_o4; |
| 28558 | |
| 28559 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_19' incorporates: |
| 28560 | * Constant: '<S244>/Constant' |
| 28561 | * Constant: '<S244>/Constant1' |
| 28562 | * Constant: '<S244>/Constant2' |
| 28563 | * Constant: '<S244>/Constant3' |
| 28564 | * Constant: '<S244>/Constant4' |
| 28565 | */ |
| 28566 | fusionAlg_B.ObjList.vision_20_obj.obj_type = fusionAlg_B.Obj_Type_eu; |
| 28567 | fusionAlg_B.ObjList.vision_20_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_o; |
| 28568 | fusionAlg_B.ObjList.vision_20_obj.obj_TTC = fusionAlg_B.Selector26.OBJ_Inv_TTC; |
| 28569 | fusionAlg_B.ObjList.vision_20_obj.obj_TTCVariance = |
| 28570 | fusionAlg_B.Selector26.OBJ_Inv_TTC_STD; |
| 28571 | fusionAlg_B.ObjList.vision_20_obj.obj_existProb = |
| 28572 | fusionAlg_P_g.Constant_Value_gb; |
| 28573 | fusionAlg_B.ObjList.vision_20_obj.obj_angleOfObject = |
| 28574 | fusionAlg_P_g.Constant1_Value_bi; |
| 28575 | fusionAlg_B.ObjList.vision_20_obj.obj_Heading = |
| 28576 | fusionAlg_B.Selector26.OBJ_Heading; |
| 28577 | fusionAlg_B.ObjList.vision_20_obj.obj_Heading_STD = |
| 28578 | fusionAlg_P_g.Constant2_Value_mi; |
| 28579 | fusionAlg_B.ObjList.vision_20_obj.obj_Heading_V = |
| 28580 | fusionAlg_P_g.Constant3_Value_e1; |
| 28581 | fusionAlg_B.ObjList.vision_20_obj.obj_Heading_STD_V = |
| 28582 | fusionAlg_P_g.Constant4_Value_jg; |
| 28583 | |
| 28584 | /* Selector: '<S223>/Selector27' incorporates: |
| 28585 | * Constant: '<S223>/Constant20' |
| 28586 | */ |
| 28587 | fusionAlg_B.Selector27 = rtu_EyeQ4_Info_st-> |
| 28588 | OBJ_BUS[fusionAlg_P_g.Constant20_Value_b]; |
| 28589 | |
| 28590 | /* DataTypeConversion: '<S245>/Data Type Conversion' */ |
| 28591 | tmp = (real32_T)floor(fusionAlg_B.Selector27.OBJ_ID); |
| 28592 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28593 | tmp = 0.0F; |
| 28594 | } else { |
| 28595 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28596 | } |
| 28597 | |
| 28598 | fusionAlg_B.ObjList.vision_21_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 28599 | (uint32_T)-tmp : (uint32_T)tmp; |
| 28600 | |
| 28601 | /* End of DataTypeConversion: '<S245>/Data Type Conversion' */ |
| 28602 | |
| 28603 | /* Lookup_n-D: '<S426>/1-D Lookup Table' */ |
| 28604 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector27.OBJ_Measuring_Status, |
| 28605 | fusionAlg_P_g.uDLookupTable_bp01Data_cm, 7U); |
| 28606 | fusionAlg_B.Obj_Status_g2 = fusionAlg_P_g.uDLookupTable_tableData_m3[bpIdx]; |
| 28607 | |
| 28608 | /* DataTypeConversion: '<S426>/Data Type Conversion1' */ |
| 28609 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_g2); |
| 28610 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28611 | tmp = 0.0F; |
| 28612 | } else { |
| 28613 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28614 | } |
| 28615 | |
| 28616 | fusionAlg_B.ObjList.vision_21_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 28617 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 28618 | |
| 28619 | /* End of DataTypeConversion: '<S426>/Data Type Conversion1' */ |
| 28620 | |
| 28621 | /* DataTypeConversion: '<S417>/Data Type Conversion' */ |
| 28622 | tmp = (real32_T)floor(fusionAlg_B.Selector27.OBJ_Object_Age); |
| 28623 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28624 | tmp = 0.0F; |
| 28625 | } else { |
| 28626 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 28627 | } |
| 28628 | |
| 28629 | fusionAlg_B.measureAge_bh = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 28630 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 28631 | |
| 28632 | /* End of DataTypeConversion: '<S417>/Data Type Conversion' */ |
| 28633 | |
| 28634 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' incorporates: |
| 28635 | * Constant: '<S417>/Constant' |
| 28636 | * Constant: '<S417>/Constant1' |
| 28637 | */ |
| 28638 | fusionAlg_B.ObjList.vision_21_obj.obj_stageAge.totalAge = |
| 28639 | fusionAlg_B.measureAge_bh; |
| 28640 | fusionAlg_B.ObjList.vision_21_obj.obj_stageAge.initAge = |
| 28641 | fusionAlg_P_g.Constant_Value_bz; |
| 28642 | fusionAlg_B.ObjList.vision_21_obj.obj_stageAge.measureAge = |
| 28643 | fusionAlg_B.measureAge_bh; |
| 28644 | fusionAlg_B.ObjList.vision_21_obj.obj_stageAge.predictAge = |
| 28645 | fusionAlg_P_g.Constant1_Value_k4; |
| 28646 | |
| 28647 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' incorporates: |
| 28648 | * Constant: '<S418>/Constant' |
| 28649 | * Constant: '<S418>/Constant1' |
| 28650 | * Constant: '<S418>/Constant2' |
| 28651 | * Constant: '<S418>/Constant3' |
| 28652 | */ |
| 28653 | fusionAlg_B.ObjList.vision_21_obj.obj_boundary.X1 = |
| 28654 | fusionAlg_P_g.Constant_Value_bd; |
| 28655 | fusionAlg_B.ObjList.vision_21_obj.obj_boundary.Y1 = |
| 28656 | fusionAlg_P_g.Constant1_Value_nw; |
| 28657 | fusionAlg_B.ObjList.vision_21_obj.obj_boundary.X2 = |
| 28658 | fusionAlg_P_g.Constant2_Value_b35; |
| 28659 | fusionAlg_B.ObjList.vision_21_obj.obj_boundary.Y2 = |
| 28660 | fusionAlg_P_g.Constant3_Value_msq; |
| 28661 | |
| 28662 | /* Lookup_n-D: '<S427>/1-D Lookup Table' */ |
| 28663 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector27.OBJ_Object_Class, |
| 28664 | fusionAlg_P_g.uDLookupTable_bp01Data_et, 8U); |
| 28665 | fusionAlg_B.Obj_Status_jm = fusionAlg_P_g.uDLookupTable_tableData_dl[bpIdx]; |
| 28666 | |
| 28667 | /* DataTypeConversion: '<S427>/Data Type Conversion2' */ |
| 28668 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_jm); |
| 28669 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28670 | tmp = 0.0F; |
| 28671 | } else { |
| 28672 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28673 | } |
| 28674 | |
| 28675 | fusionAlg_B.Obj_Type_ftw = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28676 | (uint32_T)tmp; |
| 28677 | |
| 28678 | /* End of DataTypeConversion: '<S427>/Data Type Conversion2' */ |
| 28679 | |
| 28680 | /* DataTypeConversion: '<S245>/Data Type Conversion3' */ |
| 28681 | tmp = (real32_T)floor(fusionAlg_B.Selector27.OBJ_Class_Probability); |
| 28682 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28683 | tmp = 0.0F; |
| 28684 | } else { |
| 28685 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28686 | } |
| 28687 | |
| 28688 | fusionAlg_B.Obj_TypeConf_lg = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28689 | (uint32_T)tmp; |
| 28690 | |
| 28691 | /* End of DataTypeConversion: '<S245>/Data Type Conversion3' */ |
| 28692 | |
| 28693 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' */ |
| 28694 | fusionAlg_B.ObjList.vision_21_obj.obj_coordinate.lateral = |
| 28695 | fusionAlg_B.Selector27.OBJ_Lat_Distance; |
| 28696 | fusionAlg_B.ObjList.vision_21_obj.obj_coordinate.lateralVariance = |
| 28697 | fusionAlg_B.Selector27.OBJ_Lat_Distance_STD; |
| 28698 | fusionAlg_B.ObjList.vision_21_obj.obj_coordinate.longitudinal = |
| 28699 | fusionAlg_B.Selector27.OBJ_Long_Distance; |
| 28700 | fusionAlg_B.ObjList.vision_21_obj.obj_coordinate.longitudinalVariance = |
| 28701 | fusionAlg_B.Selector27.OBJ_Long_Distance_STD; |
| 28702 | |
| 28703 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' */ |
| 28704 | fusionAlg_B.ObjList.vision_21_obj.obj_velocity.Vx = |
| 28705 | fusionAlg_B.Selector27.OBJ_Abs_Long_Velocity; |
| 28706 | fusionAlg_B.ObjList.vision_21_obj.obj_velocity.VxVariance = |
| 28707 | fusionAlg_B.Selector27.OBJ_Abs_Long_Velocity_STD; |
| 28708 | fusionAlg_B.ObjList.vision_21_obj.obj_velocity.Vy = |
| 28709 | fusionAlg_B.Selector27.OBJ_Abs_Lat_Velocity; |
| 28710 | fusionAlg_B.ObjList.vision_21_obj.obj_velocity.VyVariance = |
| 28711 | fusionAlg_B.Selector27.OBJ_Abs_Lat_Velocity_STD; |
| 28712 | |
| 28713 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' */ |
| 28714 | fusionAlg_B.ObjList.vision_21_obj.obj_angleOfCenter.centerAngle = |
| 28715 | fusionAlg_B.Selector27.OBJ_Angle_Mid; |
| 28716 | fusionAlg_B.ObjList.vision_21_obj.obj_angleOfCenter.centerAngleVariance = |
| 28717 | fusionAlg_B.Selector27.OBJ_Angle_Mid_STD; |
| 28718 | |
| 28719 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' */ |
| 28720 | fusionAlg_B.ObjList.vision_21_obj.obj_acceleration.Ax = |
| 28721 | fusionAlg_B.Selector27.OBJ_Abs_Long_Acc; |
| 28722 | fusionAlg_B.ObjList.vision_21_obj.obj_acceleration.AxVariance = |
| 28723 | fusionAlg_B.Selector27.OBJ_Abs_Long_Acc_STD; |
| 28724 | fusionAlg_B.ObjList.vision_21_obj.obj_acceleration.Ay = |
| 28725 | fusionAlg_B.Selector27.OBJ_Abs_Lat_Acc; |
| 28726 | fusionAlg_B.ObjList.vision_21_obj.obj_acceleration.AyVariance = |
| 28727 | fusionAlg_B.Selector27.OBJ_Abs_Lat_Acc_STD; |
| 28728 | |
| 28729 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' */ |
| 28730 | fusionAlg_B.ObjList.vision_21_obj.AyVariance.length = |
| 28731 | fusionAlg_B.Selector27.OBJ_Length; |
| 28732 | fusionAlg_B.ObjList.vision_21_obj.AyVariance.width = |
| 28733 | fusionAlg_B.Selector27.OBJ_Width; |
| 28734 | fusionAlg_B.ObjList.vision_21_obj.AyVariance.height = |
| 28735 | fusionAlg_B.Selector27.OBJ_Height; |
| 28736 | |
| 28737 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' incorporates: |
| 28738 | * Constant: '<S424>/Constant1' |
| 28739 | * Constant: '<S424>/Constant2' |
| 28740 | * Constant: '<S424>/Constant3' |
| 28741 | */ |
| 28742 | fusionAlg_B.ObjList.vision_21_obj.reserved1.reserved0 = |
| 28743 | fusionAlg_P_g.Constant2_Value_jnl; |
| 28744 | fusionAlg_B.ObjList.vision_21_obj.reserved1.reserved1 = |
| 28745 | fusionAlg_P_g.Constant1_Value_ah; |
| 28746 | fusionAlg_B.ObjList.vision_21_obj.reserved1.reserved2 = |
| 28747 | fusionAlg_P_g.Constant3_Value_mhz; |
| 28748 | |
| 28749 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' incorporates: |
| 28750 | * Constant: '<S425>/Constant5' |
| 28751 | * Constant: '<S425>/Constant6' |
| 28752 | */ |
| 28753 | fusionAlg_B.ObjList.vision_21_obj.reserved2.reserved0 = |
| 28754 | fusionAlg_P_g.Constant5_Value_prf; |
| 28755 | fusionAlg_B.ObjList.vision_21_obj.reserved2.reserved1 = |
| 28756 | fusionAlg_P_g.Constant6_Value_pwx; |
| 28757 | |
| 28758 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_20' incorporates: |
| 28759 | * Constant: '<S245>/Constant' |
| 28760 | * Constant: '<S245>/Constant1' |
| 28761 | * Constant: '<S245>/Constant2' |
| 28762 | * Constant: '<S245>/Constant3' |
| 28763 | * Constant: '<S245>/Constant4' |
| 28764 | */ |
| 28765 | fusionAlg_B.ObjList.vision_21_obj.obj_type = fusionAlg_B.Obj_Type_ftw; |
| 28766 | fusionAlg_B.ObjList.vision_21_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_lg; |
| 28767 | fusionAlg_B.ObjList.vision_21_obj.obj_TTC = fusionAlg_B.Selector27.OBJ_Inv_TTC; |
| 28768 | fusionAlg_B.ObjList.vision_21_obj.obj_TTCVariance = |
| 28769 | fusionAlg_B.Selector27.OBJ_Inv_TTC_STD; |
| 28770 | fusionAlg_B.ObjList.vision_21_obj.obj_existProb = |
| 28771 | fusionAlg_P_g.Constant_Value_m2; |
| 28772 | fusionAlg_B.ObjList.vision_21_obj.obj_angleOfObject = |
| 28773 | fusionAlg_P_g.Constant1_Value_lc; |
| 28774 | fusionAlg_B.ObjList.vision_21_obj.obj_Heading = |
| 28775 | fusionAlg_B.Selector27.OBJ_Heading; |
| 28776 | fusionAlg_B.ObjList.vision_21_obj.obj_Heading_STD = |
| 28777 | fusionAlg_P_g.Constant2_Value_f3; |
| 28778 | fusionAlg_B.ObjList.vision_21_obj.obj_Heading_V = |
| 28779 | fusionAlg_P_g.Constant3_Value_iu; |
| 28780 | fusionAlg_B.ObjList.vision_21_obj.obj_Heading_STD_V = |
| 28781 | fusionAlg_P_g.Constant4_Value_lb; |
| 28782 | |
| 28783 | /* Selector: '<S223>/Selector28' incorporates: |
| 28784 | * Constant: '<S223>/Constant21' |
| 28785 | */ |
| 28786 | fusionAlg_B.Selector28 = rtu_EyeQ4_Info_st-> |
| 28787 | OBJ_BUS[fusionAlg_P_g.Constant21_Value_i]; |
| 28788 | |
| 28789 | /* DataTypeConversion: '<S246>/Data Type Conversion' */ |
| 28790 | tmp = (real32_T)floor(fusionAlg_B.Selector28.OBJ_ID); |
| 28791 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28792 | tmp = 0.0F; |
| 28793 | } else { |
| 28794 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28795 | } |
| 28796 | |
| 28797 | fusionAlg_B.ObjList.vision_22_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 28798 | (uint32_T)-tmp : (uint32_T)tmp; |
| 28799 | |
| 28800 | /* End of DataTypeConversion: '<S246>/Data Type Conversion' */ |
| 28801 | |
| 28802 | /* Lookup_n-D: '<S437>/1-D Lookup Table' */ |
| 28803 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector28.OBJ_Measuring_Status, |
| 28804 | fusionAlg_P_g.uDLookupTable_bp01Data_oc, 7U); |
| 28805 | fusionAlg_B.Obj_Status_o2 = fusionAlg_P_g.uDLookupTable_tableData_ab[bpIdx]; |
| 28806 | |
| 28807 | /* DataTypeConversion: '<S437>/Data Type Conversion1' */ |
| 28808 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_o2); |
| 28809 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28810 | tmp = 0.0F; |
| 28811 | } else { |
| 28812 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28813 | } |
| 28814 | |
| 28815 | fusionAlg_B.ObjList.vision_22_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 28816 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 28817 | |
| 28818 | /* End of DataTypeConversion: '<S437>/Data Type Conversion1' */ |
| 28819 | |
| 28820 | /* DataTypeConversion: '<S428>/Data Type Conversion' */ |
| 28821 | tmp = (real32_T)floor(fusionAlg_B.Selector28.OBJ_Object_Age); |
| 28822 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28823 | tmp = 0.0F; |
| 28824 | } else { |
| 28825 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 28826 | } |
| 28827 | |
| 28828 | fusionAlg_B.measureAge_h = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 28829 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 28830 | |
| 28831 | /* End of DataTypeConversion: '<S428>/Data Type Conversion' */ |
| 28832 | |
| 28833 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' incorporates: |
| 28834 | * Constant: '<S428>/Constant' |
| 28835 | * Constant: '<S428>/Constant1' |
| 28836 | */ |
| 28837 | fusionAlg_B.ObjList.vision_22_obj.obj_stageAge.totalAge = |
| 28838 | fusionAlg_B.measureAge_h; |
| 28839 | fusionAlg_B.ObjList.vision_22_obj.obj_stageAge.initAge = |
| 28840 | fusionAlg_P_g.Constant_Value_fg; |
| 28841 | fusionAlg_B.ObjList.vision_22_obj.obj_stageAge.measureAge = |
| 28842 | fusionAlg_B.measureAge_h; |
| 28843 | fusionAlg_B.ObjList.vision_22_obj.obj_stageAge.predictAge = |
| 28844 | fusionAlg_P_g.Constant1_Value_dys; |
| 28845 | |
| 28846 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' incorporates: |
| 28847 | * Constant: '<S429>/Constant' |
| 28848 | * Constant: '<S429>/Constant1' |
| 28849 | * Constant: '<S429>/Constant2' |
| 28850 | * Constant: '<S429>/Constant3' |
| 28851 | */ |
| 28852 | fusionAlg_B.ObjList.vision_22_obj.obj_boundary.X1 = |
| 28853 | fusionAlg_P_g.Constant_Value_ny; |
| 28854 | fusionAlg_B.ObjList.vision_22_obj.obj_boundary.Y1 = |
| 28855 | fusionAlg_P_g.Constant1_Value_ib; |
| 28856 | fusionAlg_B.ObjList.vision_22_obj.obj_boundary.X2 = |
| 28857 | fusionAlg_P_g.Constant2_Value_gt; |
| 28858 | fusionAlg_B.ObjList.vision_22_obj.obj_boundary.Y2 = |
| 28859 | fusionAlg_P_g.Constant3_Value_em; |
| 28860 | |
| 28861 | /* Lookup_n-D: '<S438>/1-D Lookup Table' */ |
| 28862 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector28.OBJ_Object_Class, |
| 28863 | fusionAlg_P_g.uDLookupTable_bp01Data_aw, 8U); |
| 28864 | fusionAlg_B.Obj_Status_hk3 = fusionAlg_P_g.uDLookupTable_tableData_a0[bpIdx]; |
| 28865 | |
| 28866 | /* DataTypeConversion: '<S438>/Data Type Conversion2' */ |
| 28867 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_hk3); |
| 28868 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28869 | tmp = 0.0F; |
| 28870 | } else { |
| 28871 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28872 | } |
| 28873 | |
| 28874 | fusionAlg_B.Obj_Type_p = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28875 | (uint32_T)tmp; |
| 28876 | |
| 28877 | /* End of DataTypeConversion: '<S438>/Data Type Conversion2' */ |
| 28878 | |
| 28879 | /* DataTypeConversion: '<S246>/Data Type Conversion3' */ |
| 28880 | tmp = (real32_T)floor(fusionAlg_B.Selector28.OBJ_Class_Probability); |
| 28881 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28882 | tmp = 0.0F; |
| 28883 | } else { |
| 28884 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28885 | } |
| 28886 | |
| 28887 | fusionAlg_B.Obj_TypeConf_e = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 28888 | (uint32_T)tmp; |
| 28889 | |
| 28890 | /* End of DataTypeConversion: '<S246>/Data Type Conversion3' */ |
| 28891 | |
| 28892 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' */ |
| 28893 | fusionAlg_B.ObjList.vision_22_obj.obj_coordinate.lateral = |
| 28894 | fusionAlg_B.Selector28.OBJ_Lat_Distance; |
| 28895 | fusionAlg_B.ObjList.vision_22_obj.obj_coordinate.lateralVariance = |
| 28896 | fusionAlg_B.Selector28.OBJ_Lat_Distance_STD; |
| 28897 | fusionAlg_B.ObjList.vision_22_obj.obj_coordinate.longitudinal = |
| 28898 | fusionAlg_B.Selector28.OBJ_Long_Distance; |
| 28899 | fusionAlg_B.ObjList.vision_22_obj.obj_coordinate.longitudinalVariance = |
| 28900 | fusionAlg_B.Selector28.OBJ_Long_Distance_STD; |
| 28901 | |
| 28902 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' */ |
| 28903 | fusionAlg_B.ObjList.vision_22_obj.obj_velocity.Vx = |
| 28904 | fusionAlg_B.Selector28.OBJ_Abs_Long_Velocity; |
| 28905 | fusionAlg_B.ObjList.vision_22_obj.obj_velocity.VxVariance = |
| 28906 | fusionAlg_B.Selector28.OBJ_Abs_Long_Velocity_STD; |
| 28907 | fusionAlg_B.ObjList.vision_22_obj.obj_velocity.Vy = |
| 28908 | fusionAlg_B.Selector28.OBJ_Abs_Lat_Velocity; |
| 28909 | fusionAlg_B.ObjList.vision_22_obj.obj_velocity.VyVariance = |
| 28910 | fusionAlg_B.Selector28.OBJ_Abs_Lat_Velocity_STD; |
| 28911 | |
| 28912 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' */ |
| 28913 | fusionAlg_B.ObjList.vision_22_obj.obj_angleOfCenter.centerAngle = |
| 28914 | fusionAlg_B.Selector28.OBJ_Angle_Mid; |
| 28915 | fusionAlg_B.ObjList.vision_22_obj.obj_angleOfCenter.centerAngleVariance = |
| 28916 | fusionAlg_B.Selector28.OBJ_Angle_Mid_STD; |
| 28917 | |
| 28918 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' */ |
| 28919 | fusionAlg_B.ObjList.vision_22_obj.obj_acceleration.Ax = |
| 28920 | fusionAlg_B.Selector28.OBJ_Abs_Long_Acc; |
| 28921 | fusionAlg_B.ObjList.vision_22_obj.obj_acceleration.AxVariance = |
| 28922 | fusionAlg_B.Selector28.OBJ_Abs_Long_Acc_STD; |
| 28923 | fusionAlg_B.ObjList.vision_22_obj.obj_acceleration.Ay = |
| 28924 | fusionAlg_B.Selector28.OBJ_Abs_Lat_Acc; |
| 28925 | fusionAlg_B.ObjList.vision_22_obj.obj_acceleration.AyVariance = |
| 28926 | fusionAlg_B.Selector28.OBJ_Abs_Lat_Acc_STD; |
| 28927 | |
| 28928 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' */ |
| 28929 | fusionAlg_B.ObjList.vision_22_obj.AyVariance.length = |
| 28930 | fusionAlg_B.Selector28.OBJ_Length; |
| 28931 | fusionAlg_B.ObjList.vision_22_obj.AyVariance.width = |
| 28932 | fusionAlg_B.Selector28.OBJ_Width; |
| 28933 | fusionAlg_B.ObjList.vision_22_obj.AyVariance.height = |
| 28934 | fusionAlg_B.Selector28.OBJ_Height; |
| 28935 | |
| 28936 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' incorporates: |
| 28937 | * Constant: '<S435>/Constant1' |
| 28938 | * Constant: '<S435>/Constant2' |
| 28939 | * Constant: '<S435>/Constant3' |
| 28940 | */ |
| 28941 | fusionAlg_B.ObjList.vision_22_obj.reserved1.reserved0 = |
| 28942 | fusionAlg_P_g.Constant2_Value_ap3; |
| 28943 | fusionAlg_B.ObjList.vision_22_obj.reserved1.reserved1 = |
| 28944 | fusionAlg_P_g.Constant1_Value_oa; |
| 28945 | fusionAlg_B.ObjList.vision_22_obj.reserved1.reserved2 = |
| 28946 | fusionAlg_P_g.Constant3_Value_ktx; |
| 28947 | |
| 28948 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' incorporates: |
| 28949 | * Constant: '<S436>/Constant5' |
| 28950 | * Constant: '<S436>/Constant6' |
| 28951 | */ |
| 28952 | fusionAlg_B.ObjList.vision_22_obj.reserved2.reserved0 = |
| 28953 | fusionAlg_P_g.Constant5_Value_gj; |
| 28954 | fusionAlg_B.ObjList.vision_22_obj.reserved2.reserved1 = |
| 28955 | fusionAlg_P_g.Constant6_Value_nx; |
| 28956 | |
| 28957 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_21' incorporates: |
| 28958 | * Constant: '<S246>/Constant' |
| 28959 | * Constant: '<S246>/Constant1' |
| 28960 | * Constant: '<S246>/Constant2' |
| 28961 | * Constant: '<S246>/Constant3' |
| 28962 | * Constant: '<S246>/Constant4' |
| 28963 | */ |
| 28964 | fusionAlg_B.ObjList.vision_22_obj.obj_type = fusionAlg_B.Obj_Type_p; |
| 28965 | fusionAlg_B.ObjList.vision_22_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_e; |
| 28966 | fusionAlg_B.ObjList.vision_22_obj.obj_TTC = fusionAlg_B.Selector28.OBJ_Inv_TTC; |
| 28967 | fusionAlg_B.ObjList.vision_22_obj.obj_TTCVariance = |
| 28968 | fusionAlg_B.Selector28.OBJ_Inv_TTC_STD; |
| 28969 | fusionAlg_B.ObjList.vision_22_obj.obj_existProb = |
| 28970 | fusionAlg_P_g.Constant_Value_js; |
| 28971 | fusionAlg_B.ObjList.vision_22_obj.obj_angleOfObject = |
| 28972 | fusionAlg_P_g.Constant1_Value_jc; |
| 28973 | fusionAlg_B.ObjList.vision_22_obj.obj_Heading = |
| 28974 | fusionAlg_B.Selector28.OBJ_Heading; |
| 28975 | fusionAlg_B.ObjList.vision_22_obj.obj_Heading_STD = |
| 28976 | fusionAlg_P_g.Constant2_Value_kg; |
| 28977 | fusionAlg_B.ObjList.vision_22_obj.obj_Heading_V = |
| 28978 | fusionAlg_P_g.Constant3_Value_bl; |
| 28979 | fusionAlg_B.ObjList.vision_22_obj.obj_Heading_STD_V = |
| 28980 | fusionAlg_P_g.Constant4_Value_bz; |
| 28981 | |
| 28982 | /* Selector: '<S223>/Selector29' incorporates: |
| 28983 | * Constant: '<S223>/Constant22' |
| 28984 | */ |
| 28985 | fusionAlg_B.Selector29 = rtu_EyeQ4_Info_st-> |
| 28986 | OBJ_BUS[fusionAlg_P_g.Constant22_Value_p]; |
| 28987 | |
| 28988 | /* DataTypeConversion: '<S247>/Data Type Conversion' */ |
| 28989 | tmp = (real32_T)floor(fusionAlg_B.Selector29.OBJ_ID); |
| 28990 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 28991 | tmp = 0.0F; |
| 28992 | } else { |
| 28993 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 28994 | } |
| 28995 | |
| 28996 | fusionAlg_B.ObjList.vision_23_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 28997 | (uint32_T)-tmp : (uint32_T)tmp; |
| 28998 | |
| 28999 | /* End of DataTypeConversion: '<S247>/Data Type Conversion' */ |
| 29000 | |
| 29001 | /* Lookup_n-D: '<S448>/1-D Lookup Table' */ |
| 29002 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector29.OBJ_Measuring_Status, |
| 29003 | fusionAlg_P_g.uDLookupTable_bp01Data_nu, 7U); |
| 29004 | fusionAlg_B.Obj_Status_gk = fusionAlg_P_g.uDLookupTable_tableData_jb[bpIdx]; |
| 29005 | |
| 29006 | /* DataTypeConversion: '<S448>/Data Type Conversion1' */ |
| 29007 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_gk); |
| 29008 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29009 | tmp = 0.0F; |
| 29010 | } else { |
| 29011 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29012 | } |
| 29013 | |
| 29014 | fusionAlg_B.ObjList.vision_23_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 29015 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 29016 | |
| 29017 | /* End of DataTypeConversion: '<S448>/Data Type Conversion1' */ |
| 29018 | |
| 29019 | /* DataTypeConversion: '<S439>/Data Type Conversion' */ |
| 29020 | tmp = (real32_T)floor(fusionAlg_B.Selector29.OBJ_Object_Age); |
| 29021 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29022 | tmp = 0.0F; |
| 29023 | } else { |
| 29024 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 29025 | } |
| 29026 | |
| 29027 | fusionAlg_B.measureAge_l1 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 29028 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 29029 | |
| 29030 | /* End of DataTypeConversion: '<S439>/Data Type Conversion' */ |
| 29031 | |
| 29032 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' incorporates: |
| 29033 | * Constant: '<S439>/Constant' |
| 29034 | * Constant: '<S439>/Constant1' |
| 29035 | */ |
| 29036 | fusionAlg_B.ObjList.vision_23_obj.obj_stageAge.totalAge = |
| 29037 | fusionAlg_B.measureAge_l1; |
| 29038 | fusionAlg_B.ObjList.vision_23_obj.obj_stageAge.initAge = |
| 29039 | fusionAlg_P_g.Constant_Value_fw; |
| 29040 | fusionAlg_B.ObjList.vision_23_obj.obj_stageAge.measureAge = |
| 29041 | fusionAlg_B.measureAge_l1; |
| 29042 | fusionAlg_B.ObjList.vision_23_obj.obj_stageAge.predictAge = |
| 29043 | fusionAlg_P_g.Constant1_Value_ff; |
| 29044 | |
| 29045 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' incorporates: |
| 29046 | * Constant: '<S440>/Constant' |
| 29047 | * Constant: '<S440>/Constant1' |
| 29048 | * Constant: '<S440>/Constant2' |
| 29049 | * Constant: '<S440>/Constant3' |
| 29050 | */ |
| 29051 | fusionAlg_B.ObjList.vision_23_obj.obj_boundary.X1 = |
| 29052 | fusionAlg_P_g.Constant_Value_ed; |
| 29053 | fusionAlg_B.ObjList.vision_23_obj.obj_boundary.Y1 = |
| 29054 | fusionAlg_P_g.Constant1_Value_on; |
| 29055 | fusionAlg_B.ObjList.vision_23_obj.obj_boundary.X2 = |
| 29056 | fusionAlg_P_g.Constant2_Value_b2n; |
| 29057 | fusionAlg_B.ObjList.vision_23_obj.obj_boundary.Y2 = |
| 29058 | fusionAlg_P_g.Constant3_Value_hc; |
| 29059 | |
| 29060 | /* Lookup_n-D: '<S449>/1-D Lookup Table' */ |
| 29061 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector29.OBJ_Object_Class, |
| 29062 | fusionAlg_P_g.uDLookupTable_bp01Data_hw, 8U); |
| 29063 | fusionAlg_B.Obj_Status_hs = fusionAlg_P_g.uDLookupTable_tableData_ge[bpIdx]; |
| 29064 | |
| 29065 | /* DataTypeConversion: '<S449>/Data Type Conversion2' */ |
| 29066 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_hs); |
| 29067 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29068 | tmp = 0.0F; |
| 29069 | } else { |
| 29070 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29071 | } |
| 29072 | |
| 29073 | fusionAlg_B.Obj_Type_bk = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29074 | (uint32_T)tmp; |
| 29075 | |
| 29076 | /* End of DataTypeConversion: '<S449>/Data Type Conversion2' */ |
| 29077 | |
| 29078 | /* DataTypeConversion: '<S247>/Data Type Conversion3' */ |
| 29079 | tmp = (real32_T)floor(fusionAlg_B.Selector29.OBJ_Class_Probability); |
| 29080 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29081 | tmp = 0.0F; |
| 29082 | } else { |
| 29083 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29084 | } |
| 29085 | |
| 29086 | fusionAlg_B.Obj_TypeConf_ag = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29087 | (uint32_T)tmp; |
| 29088 | |
| 29089 | /* End of DataTypeConversion: '<S247>/Data Type Conversion3' */ |
| 29090 | |
| 29091 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' */ |
| 29092 | fusionAlg_B.ObjList.vision_23_obj.obj_coordinate.lateral = |
| 29093 | fusionAlg_B.Selector29.OBJ_Lat_Distance; |
| 29094 | fusionAlg_B.ObjList.vision_23_obj.obj_coordinate.lateralVariance = |
| 29095 | fusionAlg_B.Selector29.OBJ_Lat_Distance_STD; |
| 29096 | fusionAlg_B.ObjList.vision_23_obj.obj_coordinate.longitudinal = |
| 29097 | fusionAlg_B.Selector29.OBJ_Long_Distance; |
| 29098 | fusionAlg_B.ObjList.vision_23_obj.obj_coordinate.longitudinalVariance = |
| 29099 | fusionAlg_B.Selector29.OBJ_Long_Distance_STD; |
| 29100 | |
| 29101 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' */ |
| 29102 | fusionAlg_B.ObjList.vision_23_obj.obj_velocity.Vx = |
| 29103 | fusionAlg_B.Selector29.OBJ_Abs_Long_Velocity; |
| 29104 | fusionAlg_B.ObjList.vision_23_obj.obj_velocity.VxVariance = |
| 29105 | fusionAlg_B.Selector29.OBJ_Abs_Long_Velocity_STD; |
| 29106 | fusionAlg_B.ObjList.vision_23_obj.obj_velocity.Vy = |
| 29107 | fusionAlg_B.Selector29.OBJ_Abs_Lat_Velocity; |
| 29108 | fusionAlg_B.ObjList.vision_23_obj.obj_velocity.VyVariance = |
| 29109 | fusionAlg_B.Selector29.OBJ_Abs_Lat_Velocity_STD; |
| 29110 | |
| 29111 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' */ |
| 29112 | fusionAlg_B.ObjList.vision_23_obj.obj_angleOfCenter.centerAngle = |
| 29113 | fusionAlg_B.Selector29.OBJ_Angle_Mid; |
| 29114 | fusionAlg_B.ObjList.vision_23_obj.obj_angleOfCenter.centerAngleVariance = |
| 29115 | fusionAlg_B.Selector29.OBJ_Angle_Mid_STD; |
| 29116 | |
| 29117 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' */ |
| 29118 | fusionAlg_B.ObjList.vision_23_obj.obj_acceleration.Ax = |
| 29119 | fusionAlg_B.Selector29.OBJ_Abs_Long_Acc; |
| 29120 | fusionAlg_B.ObjList.vision_23_obj.obj_acceleration.AxVariance = |
| 29121 | fusionAlg_B.Selector29.OBJ_Abs_Long_Acc_STD; |
| 29122 | fusionAlg_B.ObjList.vision_23_obj.obj_acceleration.Ay = |
| 29123 | fusionAlg_B.Selector29.OBJ_Abs_Lat_Acc; |
| 29124 | fusionAlg_B.ObjList.vision_23_obj.obj_acceleration.AyVariance = |
| 29125 | fusionAlg_B.Selector29.OBJ_Abs_Lat_Acc_STD; |
| 29126 | |
| 29127 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' */ |
| 29128 | fusionAlg_B.ObjList.vision_23_obj.AyVariance.length = |
| 29129 | fusionAlg_B.Selector29.OBJ_Length; |
| 29130 | fusionAlg_B.ObjList.vision_23_obj.AyVariance.width = |
| 29131 | fusionAlg_B.Selector29.OBJ_Width; |
| 29132 | fusionAlg_B.ObjList.vision_23_obj.AyVariance.height = |
| 29133 | fusionAlg_B.Selector29.OBJ_Height; |
| 29134 | |
| 29135 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' incorporates: |
| 29136 | * Constant: '<S446>/Constant1' |
| 29137 | * Constant: '<S446>/Constant2' |
| 29138 | * Constant: '<S446>/Constant3' |
| 29139 | */ |
| 29140 | fusionAlg_B.ObjList.vision_23_obj.reserved1.reserved0 = |
| 29141 | fusionAlg_P_g.Constant2_Value_eq; |
| 29142 | fusionAlg_B.ObjList.vision_23_obj.reserved1.reserved1 = |
| 29143 | fusionAlg_P_g.Constant1_Value_a0; |
| 29144 | fusionAlg_B.ObjList.vision_23_obj.reserved1.reserved2 = |
| 29145 | fusionAlg_P_g.Constant3_Value_imn; |
| 29146 | |
| 29147 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' incorporates: |
| 29148 | * Constant: '<S447>/Constant5' |
| 29149 | * Constant: '<S447>/Constant6' |
| 29150 | */ |
| 29151 | fusionAlg_B.ObjList.vision_23_obj.reserved2.reserved0 = |
| 29152 | fusionAlg_P_g.Constant5_Value_jnq; |
| 29153 | fusionAlg_B.ObjList.vision_23_obj.reserved2.reserved1 = |
| 29154 | fusionAlg_P_g.Constant6_Value_ec; |
| 29155 | |
| 29156 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_22' incorporates: |
| 29157 | * Constant: '<S247>/Constant' |
| 29158 | * Constant: '<S247>/Constant1' |
| 29159 | * Constant: '<S247>/Constant2' |
| 29160 | * Constant: '<S247>/Constant3' |
| 29161 | * Constant: '<S247>/Constant4' |
| 29162 | */ |
| 29163 | fusionAlg_B.ObjList.vision_23_obj.obj_type = fusionAlg_B.Obj_Type_bk; |
| 29164 | fusionAlg_B.ObjList.vision_23_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_ag; |
| 29165 | fusionAlg_B.ObjList.vision_23_obj.obj_TTC = fusionAlg_B.Selector29.OBJ_Inv_TTC; |
| 29166 | fusionAlg_B.ObjList.vision_23_obj.obj_TTCVariance = |
| 29167 | fusionAlg_B.Selector29.OBJ_Inv_TTC_STD; |
| 29168 | fusionAlg_B.ObjList.vision_23_obj.obj_existProb = |
| 29169 | fusionAlg_P_g.Constant_Value_aj; |
| 29170 | fusionAlg_B.ObjList.vision_23_obj.obj_angleOfObject = |
| 29171 | fusionAlg_P_g.Constant1_Value_bw; |
| 29172 | fusionAlg_B.ObjList.vision_23_obj.obj_Heading = |
| 29173 | fusionAlg_B.Selector29.OBJ_Heading; |
| 29174 | fusionAlg_B.ObjList.vision_23_obj.obj_Heading_STD = |
| 29175 | fusionAlg_P_g.Constant2_Value_bwi; |
| 29176 | fusionAlg_B.ObjList.vision_23_obj.obj_Heading_V = |
| 29177 | fusionAlg_P_g.Constant3_Value_dk; |
| 29178 | fusionAlg_B.ObjList.vision_23_obj.obj_Heading_STD_V = |
| 29179 | fusionAlg_P_g.Constant4_Value_pnb; |
| 29180 | |
| 29181 | /* Selector: '<S223>/Selector30' incorporates: |
| 29182 | * Constant: '<S223>/Constant23' |
| 29183 | */ |
| 29184 | fusionAlg_B.Selector30 = rtu_EyeQ4_Info_st-> |
| 29185 | OBJ_BUS[fusionAlg_P_g.Constant23_Value_m]; |
| 29186 | |
| 29187 | /* DataTypeConversion: '<S248>/Data Type Conversion' */ |
| 29188 | tmp = (real32_T)floor(fusionAlg_B.Selector30.OBJ_ID); |
| 29189 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29190 | tmp = 0.0F; |
| 29191 | } else { |
| 29192 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29193 | } |
| 29194 | |
| 29195 | fusionAlg_B.ObjList.vision_24_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 29196 | (uint32_T)-tmp : (uint32_T)tmp; |
| 29197 | |
| 29198 | /* End of DataTypeConversion: '<S248>/Data Type Conversion' */ |
| 29199 | |
| 29200 | /* Lookup_n-D: '<S459>/1-D Lookup Table' */ |
| 29201 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector30.OBJ_Measuring_Status, |
| 29202 | fusionAlg_P_g.uDLookupTable_bp01Data_ep, 7U); |
| 29203 | fusionAlg_B.Obj_Status_er = fusionAlg_P_g.uDLookupTable_tableData_bc[bpIdx]; |
| 29204 | |
| 29205 | /* DataTypeConversion: '<S459>/Data Type Conversion1' */ |
| 29206 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_er); |
| 29207 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29208 | tmp = 0.0F; |
| 29209 | } else { |
| 29210 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29211 | } |
| 29212 | |
| 29213 | fusionAlg_B.ObjList.vision_24_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 29214 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 29215 | |
| 29216 | /* End of DataTypeConversion: '<S459>/Data Type Conversion1' */ |
| 29217 | |
| 29218 | /* DataTypeConversion: '<S450>/Data Type Conversion' */ |
| 29219 | tmp = (real32_T)floor(fusionAlg_B.Selector30.OBJ_Object_Age); |
| 29220 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29221 | tmp = 0.0F; |
| 29222 | } else { |
| 29223 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 29224 | } |
| 29225 | |
| 29226 | fusionAlg_B.measureAge_gx = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 29227 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 29228 | |
| 29229 | /* End of DataTypeConversion: '<S450>/Data Type Conversion' */ |
| 29230 | |
| 29231 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' incorporates: |
| 29232 | * Constant: '<S450>/Constant' |
| 29233 | * Constant: '<S450>/Constant1' |
| 29234 | */ |
| 29235 | fusionAlg_B.ObjList.vision_24_obj.obj_stageAge.totalAge = |
| 29236 | fusionAlg_B.measureAge_gx; |
| 29237 | fusionAlg_B.ObjList.vision_24_obj.obj_stageAge.initAge = |
| 29238 | fusionAlg_P_g.Constant_Value_kw1; |
| 29239 | fusionAlg_B.ObjList.vision_24_obj.obj_stageAge.measureAge = |
| 29240 | fusionAlg_B.measureAge_gx; |
| 29241 | fusionAlg_B.ObjList.vision_24_obj.obj_stageAge.predictAge = |
| 29242 | fusionAlg_P_g.Constant1_Value_n2; |
| 29243 | |
| 29244 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' incorporates: |
| 29245 | * Constant: '<S451>/Constant' |
| 29246 | * Constant: '<S451>/Constant1' |
| 29247 | * Constant: '<S451>/Constant2' |
| 29248 | * Constant: '<S451>/Constant3' |
| 29249 | */ |
| 29250 | fusionAlg_B.ObjList.vision_24_obj.obj_boundary.X1 = |
| 29251 | fusionAlg_P_g.Constant_Value_mp; |
| 29252 | fusionAlg_B.ObjList.vision_24_obj.obj_boundary.Y1 = |
| 29253 | fusionAlg_P_g.Constant1_Value_gx; |
| 29254 | fusionAlg_B.ObjList.vision_24_obj.obj_boundary.X2 = |
| 29255 | fusionAlg_P_g.Constant2_Value_kvm; |
| 29256 | fusionAlg_B.ObjList.vision_24_obj.obj_boundary.Y2 = |
| 29257 | fusionAlg_P_g.Constant3_Value_ab; |
| 29258 | |
| 29259 | /* Lookup_n-D: '<S460>/1-D Lookup Table' */ |
| 29260 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector30.OBJ_Object_Class, |
| 29261 | fusionAlg_P_g.uDLookupTable_bp01Data_ib, 8U); |
| 29262 | fusionAlg_B.Obj_Status_nu = fusionAlg_P_g.uDLookupTable_tableData_dy[bpIdx]; |
| 29263 | |
| 29264 | /* DataTypeConversion: '<S460>/Data Type Conversion2' */ |
| 29265 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_nu); |
| 29266 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29267 | tmp = 0.0F; |
| 29268 | } else { |
| 29269 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29270 | } |
| 29271 | |
| 29272 | fusionAlg_B.Obj_Type_ez = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29273 | (uint32_T)tmp; |
| 29274 | |
| 29275 | /* End of DataTypeConversion: '<S460>/Data Type Conversion2' */ |
| 29276 | |
| 29277 | /* DataTypeConversion: '<S248>/Data Type Conversion3' */ |
| 29278 | tmp = (real32_T)floor(fusionAlg_B.Selector30.OBJ_Class_Probability); |
| 29279 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29280 | tmp = 0.0F; |
| 29281 | } else { |
| 29282 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29283 | } |
| 29284 | |
| 29285 | fusionAlg_B.Obj_TypeConf_fp = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29286 | (uint32_T)tmp; |
| 29287 | |
| 29288 | /* End of DataTypeConversion: '<S248>/Data Type Conversion3' */ |
| 29289 | |
| 29290 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' */ |
| 29291 | fusionAlg_B.ObjList.vision_24_obj.obj_coordinate.lateral = |
| 29292 | fusionAlg_B.Selector30.OBJ_Lat_Distance; |
| 29293 | fusionAlg_B.ObjList.vision_24_obj.obj_coordinate.lateralVariance = |
| 29294 | fusionAlg_B.Selector30.OBJ_Lat_Distance_STD; |
| 29295 | fusionAlg_B.ObjList.vision_24_obj.obj_coordinate.longitudinal = |
| 29296 | fusionAlg_B.Selector30.OBJ_Long_Distance; |
| 29297 | fusionAlg_B.ObjList.vision_24_obj.obj_coordinate.longitudinalVariance = |
| 29298 | fusionAlg_B.Selector30.OBJ_Long_Distance_STD; |
| 29299 | |
| 29300 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' */ |
| 29301 | fusionAlg_B.ObjList.vision_24_obj.obj_velocity.Vx = |
| 29302 | fusionAlg_B.Selector30.OBJ_Abs_Long_Velocity; |
| 29303 | fusionAlg_B.ObjList.vision_24_obj.obj_velocity.VxVariance = |
| 29304 | fusionAlg_B.Selector30.OBJ_Abs_Long_Velocity_STD; |
| 29305 | fusionAlg_B.ObjList.vision_24_obj.obj_velocity.Vy = |
| 29306 | fusionAlg_B.Selector30.OBJ_Abs_Lat_Velocity; |
| 29307 | fusionAlg_B.ObjList.vision_24_obj.obj_velocity.VyVariance = |
| 29308 | fusionAlg_B.Selector30.OBJ_Abs_Lat_Velocity_STD; |
| 29309 | |
| 29310 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' */ |
| 29311 | fusionAlg_B.ObjList.vision_24_obj.obj_angleOfCenter.centerAngle = |
| 29312 | fusionAlg_B.Selector30.OBJ_Angle_Mid; |
| 29313 | fusionAlg_B.ObjList.vision_24_obj.obj_angleOfCenter.centerAngleVariance = |
| 29314 | fusionAlg_B.Selector30.OBJ_Angle_Mid_STD; |
| 29315 | |
| 29316 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' */ |
| 29317 | fusionAlg_B.ObjList.vision_24_obj.obj_acceleration.Ax = |
| 29318 | fusionAlg_B.Selector30.OBJ_Abs_Long_Acc; |
| 29319 | fusionAlg_B.ObjList.vision_24_obj.obj_acceleration.AxVariance = |
| 29320 | fusionAlg_B.Selector30.OBJ_Abs_Long_Acc_STD; |
| 29321 | fusionAlg_B.ObjList.vision_24_obj.obj_acceleration.Ay = |
| 29322 | fusionAlg_B.Selector30.OBJ_Abs_Lat_Acc; |
| 29323 | fusionAlg_B.ObjList.vision_24_obj.obj_acceleration.AyVariance = |
| 29324 | fusionAlg_B.Selector30.OBJ_Abs_Lat_Acc_STD; |
| 29325 | |
| 29326 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' */ |
| 29327 | fusionAlg_B.ObjList.vision_24_obj.AyVariance.length = |
| 29328 | fusionAlg_B.Selector30.OBJ_Length; |
| 29329 | fusionAlg_B.ObjList.vision_24_obj.AyVariance.width = |
| 29330 | fusionAlg_B.Selector30.OBJ_Width; |
| 29331 | fusionAlg_B.ObjList.vision_24_obj.AyVariance.height = |
| 29332 | fusionAlg_B.Selector30.OBJ_Height; |
| 29333 | |
| 29334 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' incorporates: |
| 29335 | * Constant: '<S457>/Constant1' |
| 29336 | * Constant: '<S457>/Constant2' |
| 29337 | * Constant: '<S457>/Constant3' |
| 29338 | */ |
| 29339 | fusionAlg_B.ObjList.vision_24_obj.reserved1.reserved0 = |
| 29340 | fusionAlg_P_g.Constant2_Value_av; |
| 29341 | fusionAlg_B.ObjList.vision_24_obj.reserved1.reserved1 = |
| 29342 | fusionAlg_P_g.Constant1_Value_gu; |
| 29343 | fusionAlg_B.ObjList.vision_24_obj.reserved1.reserved2 = |
| 29344 | fusionAlg_P_g.Constant3_Value_oy; |
| 29345 | |
| 29346 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' incorporates: |
| 29347 | * Constant: '<S458>/Constant5' |
| 29348 | * Constant: '<S458>/Constant6' |
| 29349 | */ |
| 29350 | fusionAlg_B.ObjList.vision_24_obj.reserved2.reserved0 = |
| 29351 | fusionAlg_P_g.Constant5_Value_bm; |
| 29352 | fusionAlg_B.ObjList.vision_24_obj.reserved2.reserved1 = |
| 29353 | fusionAlg_P_g.Constant6_Value_ew; |
| 29354 | |
| 29355 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_23' incorporates: |
| 29356 | * Constant: '<S248>/Constant' |
| 29357 | * Constant: '<S248>/Constant1' |
| 29358 | * Constant: '<S248>/Constant2' |
| 29359 | * Constant: '<S248>/Constant3' |
| 29360 | * Constant: '<S248>/Constant4' |
| 29361 | */ |
| 29362 | fusionAlg_B.ObjList.vision_24_obj.obj_type = fusionAlg_B.Obj_Type_ez; |
| 29363 | fusionAlg_B.ObjList.vision_24_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_fp; |
| 29364 | fusionAlg_B.ObjList.vision_24_obj.obj_TTC = fusionAlg_B.Selector30.OBJ_Inv_TTC; |
| 29365 | fusionAlg_B.ObjList.vision_24_obj.obj_TTCVariance = |
| 29366 | fusionAlg_B.Selector30.OBJ_Inv_TTC_STD; |
| 29367 | fusionAlg_B.ObjList.vision_24_obj.obj_existProb = |
| 29368 | fusionAlg_P_g.Constant_Value_al; |
| 29369 | fusionAlg_B.ObjList.vision_24_obj.obj_angleOfObject = |
| 29370 | fusionAlg_P_g.Constant1_Value_j4; |
| 29371 | fusionAlg_B.ObjList.vision_24_obj.obj_Heading = |
| 29372 | fusionAlg_B.Selector30.OBJ_Heading; |
| 29373 | fusionAlg_B.ObjList.vision_24_obj.obj_Heading_STD = |
| 29374 | fusionAlg_P_g.Constant2_Value_ljy; |
| 29375 | fusionAlg_B.ObjList.vision_24_obj.obj_Heading_V = |
| 29376 | fusionAlg_P_g.Constant3_Value_et; |
| 29377 | fusionAlg_B.ObjList.vision_24_obj.obj_Heading_STD_V = |
| 29378 | fusionAlg_P_g.Constant4_Value_fm0; |
| 29379 | |
| 29380 | /* Selector: '<S223>/Selector17' incorporates: |
| 29381 | * Constant: '<S223>/Constant24' |
| 29382 | */ |
| 29383 | fusionAlg_B.Selector17 = rtu_EyeQ4_Info_st-> |
| 29384 | OBJ_BUS[fusionAlg_P_g.Constant24_Value_j]; |
| 29385 | |
| 29386 | /* DataTypeConversion: '<S249>/Data Type Conversion' */ |
| 29387 | tmp = (real32_T)floor(fusionAlg_B.Selector17.OBJ_ID); |
| 29388 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29389 | tmp = 0.0F; |
| 29390 | } else { |
| 29391 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29392 | } |
| 29393 | |
| 29394 | fusionAlg_B.ObjList.vision_25_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 29395 | (uint32_T)-tmp : (uint32_T)tmp; |
| 29396 | |
| 29397 | /* End of DataTypeConversion: '<S249>/Data Type Conversion' */ |
| 29398 | |
| 29399 | /* Lookup_n-D: '<S470>/1-D Lookup Table' */ |
| 29400 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector17.OBJ_Measuring_Status, |
| 29401 | fusionAlg_P_g.uDLookupTable_bp01Data_d, 7U); |
| 29402 | fusionAlg_B.Obj_Status_gj = fusionAlg_P_g.uDLookupTable_tableData_bch[bpIdx]; |
| 29403 | |
| 29404 | /* DataTypeConversion: '<S470>/Data Type Conversion1' */ |
| 29405 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_gj); |
| 29406 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29407 | tmp = 0.0F; |
| 29408 | } else { |
| 29409 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29410 | } |
| 29411 | |
| 29412 | fusionAlg_B.ObjList.vision_25_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 29413 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 29414 | |
| 29415 | /* End of DataTypeConversion: '<S470>/Data Type Conversion1' */ |
| 29416 | |
| 29417 | /* DataTypeConversion: '<S461>/Data Type Conversion' */ |
| 29418 | tmp = (real32_T)floor(fusionAlg_B.Selector17.OBJ_Object_Age); |
| 29419 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29420 | tmp = 0.0F; |
| 29421 | } else { |
| 29422 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 29423 | } |
| 29424 | |
| 29425 | fusionAlg_B.measureAge_ez = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 29426 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 29427 | |
| 29428 | /* End of DataTypeConversion: '<S461>/Data Type Conversion' */ |
| 29429 | |
| 29430 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' incorporates: |
| 29431 | * Constant: '<S461>/Constant' |
| 29432 | * Constant: '<S461>/Constant1' |
| 29433 | */ |
| 29434 | fusionAlg_B.ObjList.vision_25_obj.obj_stageAge.totalAge = |
| 29435 | fusionAlg_B.measureAge_ez; |
| 29436 | fusionAlg_B.ObjList.vision_25_obj.obj_stageAge.initAge = |
| 29437 | fusionAlg_P_g.Constant_Value_ir; |
| 29438 | fusionAlg_B.ObjList.vision_25_obj.obj_stageAge.measureAge = |
| 29439 | fusionAlg_B.measureAge_ez; |
| 29440 | fusionAlg_B.ObjList.vision_25_obj.obj_stageAge.predictAge = |
| 29441 | fusionAlg_P_g.Constant1_Value_dg; |
| 29442 | |
| 29443 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' incorporates: |
| 29444 | * Constant: '<S462>/Constant' |
| 29445 | * Constant: '<S462>/Constant1' |
| 29446 | * Constant: '<S462>/Constant2' |
| 29447 | * Constant: '<S462>/Constant3' |
| 29448 | */ |
| 29449 | fusionAlg_B.ObjList.vision_25_obj.obj_boundary.X1 = |
| 29450 | fusionAlg_P_g.Constant_Value_p5; |
| 29451 | fusionAlg_B.ObjList.vision_25_obj.obj_boundary.Y1 = |
| 29452 | fusionAlg_P_g.Constant1_Value_b; |
| 29453 | fusionAlg_B.ObjList.vision_25_obj.obj_boundary.X2 = |
| 29454 | fusionAlg_P_g.Constant2_Value_kvs; |
| 29455 | fusionAlg_B.ObjList.vision_25_obj.obj_boundary.Y2 = |
| 29456 | fusionAlg_P_g.Constant3_Value_ggy; |
| 29457 | |
| 29458 | /* Lookup_n-D: '<S471>/1-D Lookup Table' */ |
| 29459 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector17.OBJ_Object_Class, |
| 29460 | fusionAlg_P_g.uDLookupTable_bp01Data_j, 8U); |
| 29461 | fusionAlg_B.Obj_Status_ig = fusionAlg_P_g.uDLookupTable_tableData_nv3[bpIdx]; |
| 29462 | |
| 29463 | /* DataTypeConversion: '<S471>/Data Type Conversion2' */ |
| 29464 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ig); |
| 29465 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29466 | tmp = 0.0F; |
| 29467 | } else { |
| 29468 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29469 | } |
| 29470 | |
| 29471 | fusionAlg_B.Obj_Type_bg = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29472 | (uint32_T)tmp; |
| 29473 | |
| 29474 | /* End of DataTypeConversion: '<S471>/Data Type Conversion2' */ |
| 29475 | |
| 29476 | /* DataTypeConversion: '<S249>/Data Type Conversion3' */ |
| 29477 | tmp = (real32_T)floor(fusionAlg_B.Selector17.OBJ_Class_Probability); |
| 29478 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29479 | tmp = 0.0F; |
| 29480 | } else { |
| 29481 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29482 | } |
| 29483 | |
| 29484 | fusionAlg_B.Obj_TypeConf_da = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29485 | (uint32_T)tmp; |
| 29486 | |
| 29487 | /* End of DataTypeConversion: '<S249>/Data Type Conversion3' */ |
| 29488 | |
| 29489 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' */ |
| 29490 | fusionAlg_B.ObjList.vision_25_obj.obj_coordinate.lateral = |
| 29491 | fusionAlg_B.Selector17.OBJ_Lat_Distance; |
| 29492 | fusionAlg_B.ObjList.vision_25_obj.obj_coordinate.lateralVariance = |
| 29493 | fusionAlg_B.Selector17.OBJ_Lat_Distance_STD; |
| 29494 | fusionAlg_B.ObjList.vision_25_obj.obj_coordinate.longitudinal = |
| 29495 | fusionAlg_B.Selector17.OBJ_Long_Distance; |
| 29496 | fusionAlg_B.ObjList.vision_25_obj.obj_coordinate.longitudinalVariance = |
| 29497 | fusionAlg_B.Selector17.OBJ_Long_Distance_STD; |
| 29498 | |
| 29499 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' */ |
| 29500 | fusionAlg_B.ObjList.vision_25_obj.obj_velocity.Vx = |
| 29501 | fusionAlg_B.Selector17.OBJ_Abs_Long_Velocity; |
| 29502 | fusionAlg_B.ObjList.vision_25_obj.obj_velocity.VxVariance = |
| 29503 | fusionAlg_B.Selector17.OBJ_Abs_Long_Velocity_STD; |
| 29504 | fusionAlg_B.ObjList.vision_25_obj.obj_velocity.Vy = |
| 29505 | fusionAlg_B.Selector17.OBJ_Abs_Lat_Velocity; |
| 29506 | fusionAlg_B.ObjList.vision_25_obj.obj_velocity.VyVariance = |
| 29507 | fusionAlg_B.Selector17.OBJ_Abs_Lat_Velocity_STD; |
| 29508 | |
| 29509 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' */ |
| 29510 | fusionAlg_B.ObjList.vision_25_obj.obj_angleOfCenter.centerAngle = |
| 29511 | fusionAlg_B.Selector17.OBJ_Angle_Mid; |
| 29512 | fusionAlg_B.ObjList.vision_25_obj.obj_angleOfCenter.centerAngleVariance = |
| 29513 | fusionAlg_B.Selector17.OBJ_Angle_Mid_STD; |
| 29514 | |
| 29515 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' */ |
| 29516 | fusionAlg_B.ObjList.vision_25_obj.obj_acceleration.Ax = |
| 29517 | fusionAlg_B.Selector17.OBJ_Abs_Long_Acc; |
| 29518 | fusionAlg_B.ObjList.vision_25_obj.obj_acceleration.AxVariance = |
| 29519 | fusionAlg_B.Selector17.OBJ_Abs_Long_Acc_STD; |
| 29520 | fusionAlg_B.ObjList.vision_25_obj.obj_acceleration.Ay = |
| 29521 | fusionAlg_B.Selector17.OBJ_Abs_Lat_Acc; |
| 29522 | fusionAlg_B.ObjList.vision_25_obj.obj_acceleration.AyVariance = |
| 29523 | fusionAlg_B.Selector17.OBJ_Abs_Lat_Acc_STD; |
| 29524 | |
| 29525 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' */ |
| 29526 | fusionAlg_B.ObjList.vision_25_obj.AyVariance.length = |
| 29527 | fusionAlg_B.Selector17.OBJ_Length; |
| 29528 | fusionAlg_B.ObjList.vision_25_obj.AyVariance.width = |
| 29529 | fusionAlg_B.Selector17.OBJ_Width; |
| 29530 | fusionAlg_B.ObjList.vision_25_obj.AyVariance.height = |
| 29531 | fusionAlg_B.Selector17.OBJ_Height; |
| 29532 | |
| 29533 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' incorporates: |
| 29534 | * Constant: '<S468>/Constant1' |
| 29535 | * Constant: '<S468>/Constant2' |
| 29536 | * Constant: '<S468>/Constant3' |
| 29537 | */ |
| 29538 | fusionAlg_B.ObjList.vision_25_obj.reserved1.reserved0 = |
| 29539 | fusionAlg_P_g.Constant2_Value_hq; |
| 29540 | fusionAlg_B.ObjList.vision_25_obj.reserved1.reserved1 = |
| 29541 | fusionAlg_P_g.Constant1_Value_da; |
| 29542 | fusionAlg_B.ObjList.vision_25_obj.reserved1.reserved2 = |
| 29543 | fusionAlg_P_g.Constant3_Value_gsr; |
| 29544 | |
| 29545 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' incorporates: |
| 29546 | * Constant: '<S469>/Constant5' |
| 29547 | * Constant: '<S469>/Constant6' |
| 29548 | */ |
| 29549 | fusionAlg_B.ObjList.vision_25_obj.reserved2.reserved0 = |
| 29550 | fusionAlg_P_g.Constant5_Value_dw; |
| 29551 | fusionAlg_B.ObjList.vision_25_obj.reserved2.reserved1 = |
| 29552 | fusionAlg_P_g.Constant6_Value_kg; |
| 29553 | |
| 29554 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_24' incorporates: |
| 29555 | * Constant: '<S249>/Constant' |
| 29556 | * Constant: '<S249>/Constant1' |
| 29557 | * Constant: '<S249>/Constant2' |
| 29558 | * Constant: '<S249>/Constant3' |
| 29559 | * Constant: '<S249>/Constant4' |
| 29560 | */ |
| 29561 | fusionAlg_B.ObjList.vision_25_obj.obj_type = fusionAlg_B.Obj_Type_bg; |
| 29562 | fusionAlg_B.ObjList.vision_25_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_da; |
| 29563 | fusionAlg_B.ObjList.vision_25_obj.obj_TTC = fusionAlg_B.Selector17.OBJ_Inv_TTC; |
| 29564 | fusionAlg_B.ObjList.vision_25_obj.obj_TTCVariance = |
| 29565 | fusionAlg_B.Selector17.OBJ_Inv_TTC_STD; |
| 29566 | fusionAlg_B.ObjList.vision_25_obj.obj_existProb = |
| 29567 | fusionAlg_P_g.Constant_Value_oq; |
| 29568 | fusionAlg_B.ObjList.vision_25_obj.obj_angleOfObject = |
| 29569 | fusionAlg_P_g.Constant1_Value_lhc; |
| 29570 | fusionAlg_B.ObjList.vision_25_obj.obj_Heading = |
| 29571 | fusionAlg_B.Selector17.OBJ_Heading; |
| 29572 | fusionAlg_B.ObjList.vision_25_obj.obj_Heading_STD = |
| 29573 | fusionAlg_P_g.Constant2_Value_h5; |
| 29574 | fusionAlg_B.ObjList.vision_25_obj.obj_Heading_V = |
| 29575 | fusionAlg_P_g.Constant3_Value_bi; |
| 29576 | fusionAlg_B.ObjList.vision_25_obj.obj_Heading_STD_V = |
| 29577 | fusionAlg_P_g.Constant4_Value_pf; |
| 29578 | |
| 29579 | /* Selector: '<S223>/Selector18' incorporates: |
| 29580 | * Constant: '<S223>/Constant25' |
| 29581 | */ |
| 29582 | fusionAlg_B.Selector18 = rtu_EyeQ4_Info_st-> |
| 29583 | OBJ_BUS[fusionAlg_P_g.Constant25_Value_c]; |
| 29584 | |
| 29585 | /* DataTypeConversion: '<S250>/Data Type Conversion' */ |
| 29586 | tmp = (real32_T)floor(fusionAlg_B.Selector18.OBJ_ID); |
| 29587 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29588 | tmp = 0.0F; |
| 29589 | } else { |
| 29590 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29591 | } |
| 29592 | |
| 29593 | fusionAlg_B.ObjList.vision_26_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 29594 | (uint32_T)-tmp : (uint32_T)tmp; |
| 29595 | |
| 29596 | /* End of DataTypeConversion: '<S250>/Data Type Conversion' */ |
| 29597 | |
| 29598 | /* Lookup_n-D: '<S481>/1-D Lookup Table' */ |
| 29599 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector18.OBJ_Measuring_Status, |
| 29600 | fusionAlg_P_g.uDLookupTable_bp01Data_a4, 7U); |
| 29601 | fusionAlg_B.Obj_Status_aw = fusionAlg_P_g.uDLookupTable_tableData_cv[bpIdx]; |
| 29602 | |
| 29603 | /* DataTypeConversion: '<S481>/Data Type Conversion1' */ |
| 29604 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_aw); |
| 29605 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29606 | tmp = 0.0F; |
| 29607 | } else { |
| 29608 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29609 | } |
| 29610 | |
| 29611 | fusionAlg_B.ObjList.vision_26_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 29612 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 29613 | |
| 29614 | /* End of DataTypeConversion: '<S481>/Data Type Conversion1' */ |
| 29615 | |
| 29616 | /* DataTypeConversion: '<S472>/Data Type Conversion' */ |
| 29617 | tmp = (real32_T)floor(fusionAlg_B.Selector18.OBJ_Object_Age); |
| 29618 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29619 | tmp = 0.0F; |
| 29620 | } else { |
| 29621 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 29622 | } |
| 29623 | |
| 29624 | fusionAlg_B.measureAge_nm = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 29625 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 29626 | |
| 29627 | /* End of DataTypeConversion: '<S472>/Data Type Conversion' */ |
| 29628 | |
| 29629 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' incorporates: |
| 29630 | * Constant: '<S472>/Constant' |
| 29631 | * Constant: '<S472>/Constant1' |
| 29632 | */ |
| 29633 | fusionAlg_B.ObjList.vision_26_obj.obj_stageAge.totalAge = |
| 29634 | fusionAlg_B.measureAge_nm; |
| 29635 | fusionAlg_B.ObjList.vision_26_obj.obj_stageAge.initAge = |
| 29636 | fusionAlg_P_g.Constant_Value_bg; |
| 29637 | fusionAlg_B.ObjList.vision_26_obj.obj_stageAge.measureAge = |
| 29638 | fusionAlg_B.measureAge_nm; |
| 29639 | fusionAlg_B.ObjList.vision_26_obj.obj_stageAge.predictAge = |
| 29640 | fusionAlg_P_g.Constant1_Value_l3; |
| 29641 | |
| 29642 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' incorporates: |
| 29643 | * Constant: '<S473>/Constant' |
| 29644 | * Constant: '<S473>/Constant1' |
| 29645 | * Constant: '<S473>/Constant2' |
| 29646 | * Constant: '<S473>/Constant3' |
| 29647 | */ |
| 29648 | fusionAlg_B.ObjList.vision_26_obj.obj_boundary.X1 = |
| 29649 | fusionAlg_P_g.Constant_Value_kw; |
| 29650 | fusionAlg_B.ObjList.vision_26_obj.obj_boundary.Y1 = |
| 29651 | fusionAlg_P_g.Constant1_Value_j; |
| 29652 | fusionAlg_B.ObjList.vision_26_obj.obj_boundary.X2 = |
| 29653 | fusionAlg_P_g.Constant2_Value_jp; |
| 29654 | fusionAlg_B.ObjList.vision_26_obj.obj_boundary.Y2 = |
| 29655 | fusionAlg_P_g.Constant3_Value_dl; |
| 29656 | |
| 29657 | /* Lookup_n-D: '<S482>/1-D Lookup Table' */ |
| 29658 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector18.OBJ_Object_Class, |
| 29659 | fusionAlg_P_g.uDLookupTable_bp01Data_dm, 8U); |
| 29660 | fusionAlg_B.Obj_Status_kx = fusionAlg_P_g.uDLookupTable_tableData_ks[bpIdx]; |
| 29661 | |
| 29662 | /* DataTypeConversion: '<S482>/Data Type Conversion2' */ |
| 29663 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_kx); |
| 29664 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29665 | tmp = 0.0F; |
| 29666 | } else { |
| 29667 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29668 | } |
| 29669 | |
| 29670 | fusionAlg_B.Obj_Type_d5 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29671 | (uint32_T)tmp; |
| 29672 | |
| 29673 | /* End of DataTypeConversion: '<S482>/Data Type Conversion2' */ |
| 29674 | |
| 29675 | /* DataTypeConversion: '<S250>/Data Type Conversion3' */ |
| 29676 | tmp = (real32_T)floor(fusionAlg_B.Selector18.OBJ_Class_Probability); |
| 29677 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29678 | tmp = 0.0F; |
| 29679 | } else { |
| 29680 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29681 | } |
| 29682 | |
| 29683 | fusionAlg_B.Obj_TypeConf_cr = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29684 | (uint32_T)tmp; |
| 29685 | |
| 29686 | /* End of DataTypeConversion: '<S250>/Data Type Conversion3' */ |
| 29687 | |
| 29688 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' */ |
| 29689 | fusionAlg_B.ObjList.vision_26_obj.obj_coordinate.lateral = |
| 29690 | fusionAlg_B.Selector18.OBJ_Lat_Distance; |
| 29691 | fusionAlg_B.ObjList.vision_26_obj.obj_coordinate.lateralVariance = |
| 29692 | fusionAlg_B.Selector18.OBJ_Lat_Distance_STD; |
| 29693 | fusionAlg_B.ObjList.vision_26_obj.obj_coordinate.longitudinal = |
| 29694 | fusionAlg_B.Selector18.OBJ_Long_Distance; |
| 29695 | fusionAlg_B.ObjList.vision_26_obj.obj_coordinate.longitudinalVariance = |
| 29696 | fusionAlg_B.Selector18.OBJ_Long_Distance_STD; |
| 29697 | |
| 29698 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' */ |
| 29699 | fusionAlg_B.ObjList.vision_26_obj.obj_velocity.Vx = |
| 29700 | fusionAlg_B.Selector18.OBJ_Abs_Long_Velocity; |
| 29701 | fusionAlg_B.ObjList.vision_26_obj.obj_velocity.VxVariance = |
| 29702 | fusionAlg_B.Selector18.OBJ_Abs_Long_Velocity_STD; |
| 29703 | fusionAlg_B.ObjList.vision_26_obj.obj_velocity.Vy = |
| 29704 | fusionAlg_B.Selector18.OBJ_Abs_Lat_Velocity; |
| 29705 | fusionAlg_B.ObjList.vision_26_obj.obj_velocity.VyVariance = |
| 29706 | fusionAlg_B.Selector18.OBJ_Abs_Lat_Velocity_STD; |
| 29707 | |
| 29708 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' */ |
| 29709 | fusionAlg_B.ObjList.vision_26_obj.obj_angleOfCenter.centerAngle = |
| 29710 | fusionAlg_B.Selector18.OBJ_Angle_Mid; |
| 29711 | fusionAlg_B.ObjList.vision_26_obj.obj_angleOfCenter.centerAngleVariance = |
| 29712 | fusionAlg_B.Selector18.OBJ_Angle_Mid_STD; |
| 29713 | |
| 29714 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' */ |
| 29715 | fusionAlg_B.ObjList.vision_26_obj.obj_acceleration.Ax = |
| 29716 | fusionAlg_B.Selector18.OBJ_Abs_Long_Acc; |
| 29717 | fusionAlg_B.ObjList.vision_26_obj.obj_acceleration.AxVariance = |
| 29718 | fusionAlg_B.Selector18.OBJ_Abs_Long_Acc_STD; |
| 29719 | fusionAlg_B.ObjList.vision_26_obj.obj_acceleration.Ay = |
| 29720 | fusionAlg_B.Selector18.OBJ_Abs_Lat_Acc; |
| 29721 | fusionAlg_B.ObjList.vision_26_obj.obj_acceleration.AyVariance = |
| 29722 | fusionAlg_B.Selector18.OBJ_Abs_Lat_Acc_STD; |
| 29723 | |
| 29724 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' */ |
| 29725 | fusionAlg_B.ObjList.vision_26_obj.AyVariance.length = |
| 29726 | fusionAlg_B.Selector18.OBJ_Length; |
| 29727 | fusionAlg_B.ObjList.vision_26_obj.AyVariance.width = |
| 29728 | fusionAlg_B.Selector18.OBJ_Width; |
| 29729 | fusionAlg_B.ObjList.vision_26_obj.AyVariance.height = |
| 29730 | fusionAlg_B.Selector18.OBJ_Height; |
| 29731 | |
| 29732 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' incorporates: |
| 29733 | * Constant: '<S479>/Constant1' |
| 29734 | * Constant: '<S479>/Constant2' |
| 29735 | * Constant: '<S479>/Constant3' |
| 29736 | */ |
| 29737 | fusionAlg_B.ObjList.vision_26_obj.reserved1.reserved0 = |
| 29738 | fusionAlg_P_g.Constant2_Value_iw; |
| 29739 | fusionAlg_B.ObjList.vision_26_obj.reserved1.reserved1 = |
| 29740 | fusionAlg_P_g.Constant1_Value_bl; |
| 29741 | fusionAlg_B.ObjList.vision_26_obj.reserved1.reserved2 = |
| 29742 | fusionAlg_P_g.Constant3_Value_ii; |
| 29743 | |
| 29744 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' incorporates: |
| 29745 | * Constant: '<S480>/Constant5' |
| 29746 | * Constant: '<S480>/Constant6' |
| 29747 | */ |
| 29748 | fusionAlg_B.ObjList.vision_26_obj.reserved2.reserved0 = |
| 29749 | fusionAlg_P_g.Constant5_Value_o4; |
| 29750 | fusionAlg_B.ObjList.vision_26_obj.reserved2.reserved1 = |
| 29751 | fusionAlg_P_g.Constant6_Value_fg; |
| 29752 | |
| 29753 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_25' incorporates: |
| 29754 | * Constant: '<S250>/Constant' |
| 29755 | * Constant: '<S250>/Constant1' |
| 29756 | * Constant: '<S250>/Constant2' |
| 29757 | * Constant: '<S250>/Constant3' |
| 29758 | * Constant: '<S250>/Constant4' |
| 29759 | */ |
| 29760 | fusionAlg_B.ObjList.vision_26_obj.obj_type = fusionAlg_B.Obj_Type_d5; |
| 29761 | fusionAlg_B.ObjList.vision_26_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_cr; |
| 29762 | fusionAlg_B.ObjList.vision_26_obj.obj_TTC = fusionAlg_B.Selector18.OBJ_Inv_TTC; |
| 29763 | fusionAlg_B.ObjList.vision_26_obj.obj_TTCVariance = |
| 29764 | fusionAlg_B.Selector18.OBJ_Inv_TTC_STD; |
| 29765 | fusionAlg_B.ObjList.vision_26_obj.obj_existProb = |
| 29766 | fusionAlg_P_g.Constant_Value_o5; |
| 29767 | fusionAlg_B.ObjList.vision_26_obj.obj_angleOfObject = |
| 29768 | fusionAlg_P_g.Constant1_Value_hqa; |
| 29769 | fusionAlg_B.ObjList.vision_26_obj.obj_Heading = |
| 29770 | fusionAlg_B.Selector18.OBJ_Heading; |
| 29771 | fusionAlg_B.ObjList.vision_26_obj.obj_Heading_STD = |
| 29772 | fusionAlg_P_g.Constant2_Value_he; |
| 29773 | fusionAlg_B.ObjList.vision_26_obj.obj_Heading_V = |
| 29774 | fusionAlg_P_g.Constant3_Value_ec; |
| 29775 | fusionAlg_B.ObjList.vision_26_obj.obj_Heading_STD_V = |
| 29776 | fusionAlg_P_g.Constant4_Value_d4; |
| 29777 | |
| 29778 | /* Selector: '<S223>/Selector19' incorporates: |
| 29779 | * Constant: '<S223>/Constant26' |
| 29780 | */ |
| 29781 | fusionAlg_B.Selector19 = rtu_EyeQ4_Info_st-> |
| 29782 | OBJ_BUS[fusionAlg_P_g.Constant26_Value_n]; |
| 29783 | |
| 29784 | /* DataTypeConversion: '<S251>/Data Type Conversion' */ |
| 29785 | tmp = (real32_T)floor(fusionAlg_B.Selector19.OBJ_ID); |
| 29786 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29787 | tmp = 0.0F; |
| 29788 | } else { |
| 29789 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29790 | } |
| 29791 | |
| 29792 | fusionAlg_B.ObjList.vision_27_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 29793 | (uint32_T)-tmp : (uint32_T)tmp; |
| 29794 | |
| 29795 | /* End of DataTypeConversion: '<S251>/Data Type Conversion' */ |
| 29796 | |
| 29797 | /* Lookup_n-D: '<S492>/1-D Lookup Table' */ |
| 29798 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector19.OBJ_Measuring_Status, |
| 29799 | fusionAlg_P_g.uDLookupTable_bp01Data_fi, 7U); |
| 29800 | fusionAlg_B.Obj_Status_i5 = fusionAlg_P_g.uDLookupTable_tableData_jd[bpIdx]; |
| 29801 | |
| 29802 | /* DataTypeConversion: '<S492>/Data Type Conversion1' */ |
| 29803 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_i5); |
| 29804 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29805 | tmp = 0.0F; |
| 29806 | } else { |
| 29807 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29808 | } |
| 29809 | |
| 29810 | fusionAlg_B.ObjList.vision_27_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 29811 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 29812 | |
| 29813 | /* End of DataTypeConversion: '<S492>/Data Type Conversion1' */ |
| 29814 | |
| 29815 | /* DataTypeConversion: '<S483>/Data Type Conversion' */ |
| 29816 | tmp = (real32_T)floor(fusionAlg_B.Selector19.OBJ_Object_Age); |
| 29817 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29818 | tmp = 0.0F; |
| 29819 | } else { |
| 29820 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 29821 | } |
| 29822 | |
| 29823 | fusionAlg_B.measureAge_ji = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 29824 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 29825 | |
| 29826 | /* End of DataTypeConversion: '<S483>/Data Type Conversion' */ |
| 29827 | |
| 29828 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' incorporates: |
| 29829 | * Constant: '<S483>/Constant' |
| 29830 | * Constant: '<S483>/Constant1' |
| 29831 | */ |
| 29832 | fusionAlg_B.ObjList.vision_27_obj.obj_stageAge.totalAge = |
| 29833 | fusionAlg_B.measureAge_ji; |
| 29834 | fusionAlg_B.ObjList.vision_27_obj.obj_stageAge.initAge = |
| 29835 | fusionAlg_P_g.Constant_Value_kws; |
| 29836 | fusionAlg_B.ObjList.vision_27_obj.obj_stageAge.measureAge = |
| 29837 | fusionAlg_B.measureAge_ji; |
| 29838 | fusionAlg_B.ObjList.vision_27_obj.obj_stageAge.predictAge = |
| 29839 | fusionAlg_P_g.Constant1_Value_bo; |
| 29840 | |
| 29841 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' incorporates: |
| 29842 | * Constant: '<S484>/Constant' |
| 29843 | * Constant: '<S484>/Constant1' |
| 29844 | * Constant: '<S484>/Constant2' |
| 29845 | * Constant: '<S484>/Constant3' |
| 29846 | */ |
| 29847 | fusionAlg_B.ObjList.vision_27_obj.obj_boundary.X1 = |
| 29848 | fusionAlg_P_g.Constant_Value_av; |
| 29849 | fusionAlg_B.ObjList.vision_27_obj.obj_boundary.Y1 = |
| 29850 | fusionAlg_P_g.Constant1_Value_p; |
| 29851 | fusionAlg_B.ObjList.vision_27_obj.obj_boundary.X2 = |
| 29852 | fusionAlg_P_g.Constant2_Value_ji; |
| 29853 | fusionAlg_B.ObjList.vision_27_obj.obj_boundary.Y2 = |
| 29854 | fusionAlg_P_g.Constant3_Value_dx; |
| 29855 | |
| 29856 | /* Lookup_n-D: '<S493>/1-D Lookup Table' */ |
| 29857 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector19.OBJ_Object_Class, |
| 29858 | fusionAlg_P_g.uDLookupTable_bp01Data_lt, 8U); |
| 29859 | fusionAlg_B.Obj_Status_oj = fusionAlg_P_g.uDLookupTable_tableData_ka[bpIdx]; |
| 29860 | |
| 29861 | /* DataTypeConversion: '<S493>/Data Type Conversion2' */ |
| 29862 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_oj); |
| 29863 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29864 | tmp = 0.0F; |
| 29865 | } else { |
| 29866 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29867 | } |
| 29868 | |
| 29869 | fusionAlg_B.Obj_Type_i3 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29870 | (uint32_T)tmp; |
| 29871 | |
| 29872 | /* End of DataTypeConversion: '<S493>/Data Type Conversion2' */ |
| 29873 | |
| 29874 | /* DataTypeConversion: '<S251>/Data Type Conversion3' */ |
| 29875 | tmp = (real32_T)floor(fusionAlg_B.Selector19.OBJ_Class_Probability); |
| 29876 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29877 | tmp = 0.0F; |
| 29878 | } else { |
| 29879 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29880 | } |
| 29881 | |
| 29882 | fusionAlg_B.Obj_TypeConf_j = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 29883 | (uint32_T)tmp; |
| 29884 | |
| 29885 | /* End of DataTypeConversion: '<S251>/Data Type Conversion3' */ |
| 29886 | |
| 29887 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' */ |
| 29888 | fusionAlg_B.ObjList.vision_27_obj.obj_coordinate.lateral = |
| 29889 | fusionAlg_B.Selector19.OBJ_Lat_Distance; |
| 29890 | fusionAlg_B.ObjList.vision_27_obj.obj_coordinate.lateralVariance = |
| 29891 | fusionAlg_B.Selector19.OBJ_Lat_Distance_STD; |
| 29892 | fusionAlg_B.ObjList.vision_27_obj.obj_coordinate.longitudinal = |
| 29893 | fusionAlg_B.Selector19.OBJ_Long_Distance; |
| 29894 | fusionAlg_B.ObjList.vision_27_obj.obj_coordinate.longitudinalVariance = |
| 29895 | fusionAlg_B.Selector19.OBJ_Long_Distance_STD; |
| 29896 | |
| 29897 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' */ |
| 29898 | fusionAlg_B.ObjList.vision_27_obj.obj_velocity.Vx = |
| 29899 | fusionAlg_B.Selector19.OBJ_Abs_Long_Velocity; |
| 29900 | fusionAlg_B.ObjList.vision_27_obj.obj_velocity.VxVariance = |
| 29901 | fusionAlg_B.Selector19.OBJ_Abs_Long_Velocity_STD; |
| 29902 | fusionAlg_B.ObjList.vision_27_obj.obj_velocity.Vy = |
| 29903 | fusionAlg_B.Selector19.OBJ_Abs_Lat_Velocity; |
| 29904 | fusionAlg_B.ObjList.vision_27_obj.obj_velocity.VyVariance = |
| 29905 | fusionAlg_B.Selector19.OBJ_Abs_Lat_Velocity_STD; |
| 29906 | |
| 29907 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' */ |
| 29908 | fusionAlg_B.ObjList.vision_27_obj.obj_angleOfCenter.centerAngle = |
| 29909 | fusionAlg_B.Selector19.OBJ_Angle_Mid; |
| 29910 | fusionAlg_B.ObjList.vision_27_obj.obj_angleOfCenter.centerAngleVariance = |
| 29911 | fusionAlg_B.Selector19.OBJ_Angle_Mid_STD; |
| 29912 | |
| 29913 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' */ |
| 29914 | fusionAlg_B.ObjList.vision_27_obj.obj_acceleration.Ax = |
| 29915 | fusionAlg_B.Selector19.OBJ_Abs_Long_Acc; |
| 29916 | fusionAlg_B.ObjList.vision_27_obj.obj_acceleration.AxVariance = |
| 29917 | fusionAlg_B.Selector19.OBJ_Abs_Long_Acc_STD; |
| 29918 | fusionAlg_B.ObjList.vision_27_obj.obj_acceleration.Ay = |
| 29919 | fusionAlg_B.Selector19.OBJ_Abs_Lat_Acc; |
| 29920 | fusionAlg_B.ObjList.vision_27_obj.obj_acceleration.AyVariance = |
| 29921 | fusionAlg_B.Selector19.OBJ_Abs_Lat_Acc_STD; |
| 29922 | |
| 29923 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' */ |
| 29924 | fusionAlg_B.ObjList.vision_27_obj.AyVariance.length = |
| 29925 | fusionAlg_B.Selector19.OBJ_Length; |
| 29926 | fusionAlg_B.ObjList.vision_27_obj.AyVariance.width = |
| 29927 | fusionAlg_B.Selector19.OBJ_Width; |
| 29928 | fusionAlg_B.ObjList.vision_27_obj.AyVariance.height = |
| 29929 | fusionAlg_B.Selector19.OBJ_Height; |
| 29930 | |
| 29931 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' incorporates: |
| 29932 | * Constant: '<S490>/Constant1' |
| 29933 | * Constant: '<S490>/Constant2' |
| 29934 | * Constant: '<S490>/Constant3' |
| 29935 | */ |
| 29936 | fusionAlg_B.ObjList.vision_27_obj.reserved1.reserved0 = |
| 29937 | fusionAlg_P_g.Constant2_Value_hd; |
| 29938 | fusionAlg_B.ObjList.vision_27_obj.reserved1.reserved1 = |
| 29939 | fusionAlg_P_g.Constant1_Value_mu; |
| 29940 | fusionAlg_B.ObjList.vision_27_obj.reserved1.reserved2 = |
| 29941 | fusionAlg_P_g.Constant3_Value_ev; |
| 29942 | |
| 29943 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' incorporates: |
| 29944 | * Constant: '<S491>/Constant5' |
| 29945 | * Constant: '<S491>/Constant6' |
| 29946 | */ |
| 29947 | fusionAlg_B.ObjList.vision_27_obj.reserved2.reserved0 = |
| 29948 | fusionAlg_P_g.Constant5_Value_mp; |
| 29949 | fusionAlg_B.ObjList.vision_27_obj.reserved2.reserved1 = |
| 29950 | fusionAlg_P_g.Constant6_Value_dy; |
| 29951 | |
| 29952 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_26' incorporates: |
| 29953 | * Constant: '<S251>/Constant' |
| 29954 | * Constant: '<S251>/Constant1' |
| 29955 | * Constant: '<S251>/Constant2' |
| 29956 | * Constant: '<S251>/Constant3' |
| 29957 | * Constant: '<S251>/Constant4' |
| 29958 | */ |
| 29959 | fusionAlg_B.ObjList.vision_27_obj.obj_type = fusionAlg_B.Obj_Type_i3; |
| 29960 | fusionAlg_B.ObjList.vision_27_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_j; |
| 29961 | fusionAlg_B.ObjList.vision_27_obj.obj_TTC = fusionAlg_B.Selector19.OBJ_Inv_TTC; |
| 29962 | fusionAlg_B.ObjList.vision_27_obj.obj_TTCVariance = |
| 29963 | fusionAlg_B.Selector19.OBJ_Inv_TTC_STD; |
| 29964 | fusionAlg_B.ObjList.vision_27_obj.obj_existProb = |
| 29965 | fusionAlg_P_g.Constant_Value_lu; |
| 29966 | fusionAlg_B.ObjList.vision_27_obj.obj_angleOfObject = |
| 29967 | fusionAlg_P_g.Constant1_Value_mo0; |
| 29968 | fusionAlg_B.ObjList.vision_27_obj.obj_Heading = |
| 29969 | fusionAlg_B.Selector19.OBJ_Heading; |
| 29970 | fusionAlg_B.ObjList.vision_27_obj.obj_Heading_STD = |
| 29971 | fusionAlg_P_g.Constant2_Value_if; |
| 29972 | fusionAlg_B.ObjList.vision_27_obj.obj_Heading_V = |
| 29973 | fusionAlg_P_g.Constant3_Value_lb; |
| 29974 | fusionAlg_B.ObjList.vision_27_obj.obj_Heading_STD_V = |
| 29975 | fusionAlg_P_g.Constant4_Value_hc; |
| 29976 | |
| 29977 | /* Selector: '<S223>/Selector20' incorporates: |
| 29978 | * Constant: '<S223>/Constant27' |
| 29979 | */ |
| 29980 | fusionAlg_B.Selector20 = rtu_EyeQ4_Info_st-> |
| 29981 | OBJ_BUS[fusionAlg_P_g.Constant27_Value_ak]; |
| 29982 | |
| 29983 | /* DataTypeConversion: '<S252>/Data Type Conversion' */ |
| 29984 | tmp = (real32_T)floor(fusionAlg_B.Selector20.OBJ_ID); |
| 29985 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 29986 | tmp = 0.0F; |
| 29987 | } else { |
| 29988 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 29989 | } |
| 29990 | |
| 29991 | fusionAlg_B.ObjList.vision_28_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 29992 | (uint32_T)-tmp : (uint32_T)tmp; |
| 29993 | |
| 29994 | /* End of DataTypeConversion: '<S252>/Data Type Conversion' */ |
| 29995 | |
| 29996 | /* Lookup_n-D: '<S503>/1-D Lookup Table' */ |
| 29997 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector20.OBJ_Measuring_Status, |
| 29998 | fusionAlg_P_g.uDLookupTable_bp01Data_il, 7U); |
| 29999 | fusionAlg_B.Obj_Status_an = fusionAlg_P_g.uDLookupTable_tableData_jdz[bpIdx]; |
| 30000 | |
| 30001 | /* DataTypeConversion: '<S503>/Data Type Conversion1' */ |
| 30002 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_an); |
| 30003 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30004 | tmp = 0.0F; |
| 30005 | } else { |
| 30006 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30007 | } |
| 30008 | |
| 30009 | fusionAlg_B.ObjList.vision_28_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 30010 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 30011 | |
| 30012 | /* End of DataTypeConversion: '<S503>/Data Type Conversion1' */ |
| 30013 | |
| 30014 | /* DataTypeConversion: '<S494>/Data Type Conversion' */ |
| 30015 | tmp = (real32_T)floor(fusionAlg_B.Selector20.OBJ_Object_Age); |
| 30016 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30017 | tmp = 0.0F; |
| 30018 | } else { |
| 30019 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 30020 | } |
| 30021 | |
| 30022 | fusionAlg_B.measureAge_al = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 30023 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 30024 | |
| 30025 | /* End of DataTypeConversion: '<S494>/Data Type Conversion' */ |
| 30026 | |
| 30027 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' incorporates: |
| 30028 | * Constant: '<S494>/Constant' |
| 30029 | * Constant: '<S494>/Constant1' |
| 30030 | */ |
| 30031 | fusionAlg_B.ObjList.vision_28_obj.obj_stageAge.totalAge = |
| 30032 | fusionAlg_B.measureAge_al; |
| 30033 | fusionAlg_B.ObjList.vision_28_obj.obj_stageAge.initAge = |
| 30034 | fusionAlg_P_g.Constant_Value_era; |
| 30035 | fusionAlg_B.ObjList.vision_28_obj.obj_stageAge.measureAge = |
| 30036 | fusionAlg_B.measureAge_al; |
| 30037 | fusionAlg_B.ObjList.vision_28_obj.obj_stageAge.predictAge = |
| 30038 | fusionAlg_P_g.Constant1_Value_hm; |
| 30039 | |
| 30040 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' incorporates: |
| 30041 | * Constant: '<S495>/Constant' |
| 30042 | * Constant: '<S495>/Constant1' |
| 30043 | * Constant: '<S495>/Constant2' |
| 30044 | * Constant: '<S495>/Constant3' |
| 30045 | */ |
| 30046 | fusionAlg_B.ObjList.vision_28_obj.obj_boundary.X1 = |
| 30047 | fusionAlg_P_g.Constant_Value_hq; |
| 30048 | fusionAlg_B.ObjList.vision_28_obj.obj_boundary.Y1 = |
| 30049 | fusionAlg_P_g.Constant1_Value_ik; |
| 30050 | fusionAlg_B.ObjList.vision_28_obj.obj_boundary.X2 = |
| 30051 | fusionAlg_P_g.Constant2_Value_kh; |
| 30052 | fusionAlg_B.ObjList.vision_28_obj.obj_boundary.Y2 = |
| 30053 | fusionAlg_P_g.Constant3_Value_nic; |
| 30054 | |
| 30055 | /* Lookup_n-D: '<S504>/1-D Lookup Table' */ |
| 30056 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector20.OBJ_Object_Class, |
| 30057 | fusionAlg_P_g.uDLookupTable_bp01Data_eq, 8U); |
| 30058 | fusionAlg_B.Obj_Status_ib = fusionAlg_P_g.uDLookupTable_tableData_ku[bpIdx]; |
| 30059 | |
| 30060 | /* DataTypeConversion: '<S504>/Data Type Conversion2' */ |
| 30061 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ib); |
| 30062 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30063 | tmp = 0.0F; |
| 30064 | } else { |
| 30065 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30066 | } |
| 30067 | |
| 30068 | fusionAlg_B.Obj_Type_gi = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 30069 | (uint32_T)tmp; |
| 30070 | |
| 30071 | /* End of DataTypeConversion: '<S504>/Data Type Conversion2' */ |
| 30072 | |
| 30073 | /* DataTypeConversion: '<S252>/Data Type Conversion3' */ |
| 30074 | tmp = (real32_T)floor(fusionAlg_B.Selector20.OBJ_Class_Probability); |
| 30075 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30076 | tmp = 0.0F; |
| 30077 | } else { |
| 30078 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30079 | } |
| 30080 | |
| 30081 | fusionAlg_B.Obj_TypeConf_ir = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 30082 | (uint32_T)tmp; |
| 30083 | |
| 30084 | /* End of DataTypeConversion: '<S252>/Data Type Conversion3' */ |
| 30085 | |
| 30086 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' */ |
| 30087 | fusionAlg_B.ObjList.vision_28_obj.obj_coordinate.lateral = |
| 30088 | fusionAlg_B.Selector20.OBJ_Lat_Distance; |
| 30089 | fusionAlg_B.ObjList.vision_28_obj.obj_coordinate.lateralVariance = |
| 30090 | fusionAlg_B.Selector20.OBJ_Lat_Distance_STD; |
| 30091 | fusionAlg_B.ObjList.vision_28_obj.obj_coordinate.longitudinal = |
| 30092 | fusionAlg_B.Selector20.OBJ_Long_Distance; |
| 30093 | fusionAlg_B.ObjList.vision_28_obj.obj_coordinate.longitudinalVariance = |
| 30094 | fusionAlg_B.Selector20.OBJ_Long_Distance_STD; |
| 30095 | |
| 30096 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' */ |
| 30097 | fusionAlg_B.ObjList.vision_28_obj.obj_velocity.Vx = |
| 30098 | fusionAlg_B.Selector20.OBJ_Abs_Long_Velocity; |
| 30099 | fusionAlg_B.ObjList.vision_28_obj.obj_velocity.VxVariance = |
| 30100 | fusionAlg_B.Selector20.OBJ_Abs_Long_Velocity_STD; |
| 30101 | fusionAlg_B.ObjList.vision_28_obj.obj_velocity.Vy = |
| 30102 | fusionAlg_B.Selector20.OBJ_Abs_Lat_Velocity; |
| 30103 | fusionAlg_B.ObjList.vision_28_obj.obj_velocity.VyVariance = |
| 30104 | fusionAlg_B.Selector20.OBJ_Abs_Lat_Velocity_STD; |
| 30105 | |
| 30106 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' */ |
| 30107 | fusionAlg_B.ObjList.vision_28_obj.obj_angleOfCenter.centerAngle = |
| 30108 | fusionAlg_B.Selector20.OBJ_Angle_Mid; |
| 30109 | fusionAlg_B.ObjList.vision_28_obj.obj_angleOfCenter.centerAngleVariance = |
| 30110 | fusionAlg_B.Selector20.OBJ_Angle_Mid_STD; |
| 30111 | |
| 30112 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' */ |
| 30113 | fusionAlg_B.ObjList.vision_28_obj.obj_acceleration.Ax = |
| 30114 | fusionAlg_B.Selector20.OBJ_Abs_Long_Acc; |
| 30115 | fusionAlg_B.ObjList.vision_28_obj.obj_acceleration.AxVariance = |
| 30116 | fusionAlg_B.Selector20.OBJ_Abs_Long_Acc_STD; |
| 30117 | fusionAlg_B.ObjList.vision_28_obj.obj_acceleration.Ay = |
| 30118 | fusionAlg_B.Selector20.OBJ_Abs_Lat_Acc; |
| 30119 | fusionAlg_B.ObjList.vision_28_obj.obj_acceleration.AyVariance = |
| 30120 | fusionAlg_B.Selector20.OBJ_Abs_Lat_Acc_STD; |
| 30121 | |
| 30122 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' */ |
| 30123 | fusionAlg_B.ObjList.vision_28_obj.AyVariance.length = |
| 30124 | fusionAlg_B.Selector20.OBJ_Length; |
| 30125 | fusionAlg_B.ObjList.vision_28_obj.AyVariance.width = |
| 30126 | fusionAlg_B.Selector20.OBJ_Width; |
| 30127 | fusionAlg_B.ObjList.vision_28_obj.AyVariance.height = |
| 30128 | fusionAlg_B.Selector20.OBJ_Height; |
| 30129 | |
| 30130 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' incorporates: |
| 30131 | * Constant: '<S501>/Constant1' |
| 30132 | * Constant: '<S501>/Constant2' |
| 30133 | * Constant: '<S501>/Constant3' |
| 30134 | */ |
| 30135 | fusionAlg_B.ObjList.vision_28_obj.reserved1.reserved0 = |
| 30136 | fusionAlg_P_g.Constant2_Value_m0; |
| 30137 | fusionAlg_B.ObjList.vision_28_obj.reserved1.reserved1 = |
| 30138 | fusionAlg_P_g.Constant1_Value_cf; |
| 30139 | fusionAlg_B.ObjList.vision_28_obj.reserved1.reserved2 = |
| 30140 | fusionAlg_P_g.Constant3_Value_mf; |
| 30141 | |
| 30142 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' incorporates: |
| 30143 | * Constant: '<S502>/Constant5' |
| 30144 | * Constant: '<S502>/Constant6' |
| 30145 | */ |
| 30146 | fusionAlg_B.ObjList.vision_28_obj.reserved2.reserved0 = |
| 30147 | fusionAlg_P_g.Constant5_Value_kl; |
| 30148 | fusionAlg_B.ObjList.vision_28_obj.reserved2.reserved1 = |
| 30149 | fusionAlg_P_g.Constant6_Value_pd; |
| 30150 | |
| 30151 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_27' incorporates: |
| 30152 | * Constant: '<S252>/Constant' |
| 30153 | * Constant: '<S252>/Constant1' |
| 30154 | * Constant: '<S252>/Constant2' |
| 30155 | * Constant: '<S252>/Constant3' |
| 30156 | * Constant: '<S252>/Constant4' |
| 30157 | */ |
| 30158 | fusionAlg_B.ObjList.vision_28_obj.obj_type = fusionAlg_B.Obj_Type_gi; |
| 30159 | fusionAlg_B.ObjList.vision_28_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_ir; |
| 30160 | fusionAlg_B.ObjList.vision_28_obj.obj_TTC = fusionAlg_B.Selector20.OBJ_Inv_TTC; |
| 30161 | fusionAlg_B.ObjList.vision_28_obj.obj_TTCVariance = |
| 30162 | fusionAlg_B.Selector20.OBJ_Inv_TTC_STD; |
| 30163 | fusionAlg_B.ObjList.vision_28_obj.obj_existProb = |
| 30164 | fusionAlg_P_g.Constant_Value_c; |
| 30165 | fusionAlg_B.ObjList.vision_28_obj.obj_angleOfObject = |
| 30166 | fusionAlg_P_g.Constant1_Value_lj; |
| 30167 | fusionAlg_B.ObjList.vision_28_obj.obj_Heading = |
| 30168 | fusionAlg_B.Selector20.OBJ_Heading; |
| 30169 | fusionAlg_B.ObjList.vision_28_obj.obj_Heading_STD = |
| 30170 | fusionAlg_P_g.Constant2_Value_as; |
| 30171 | fusionAlg_B.ObjList.vision_28_obj.obj_Heading_V = |
| 30172 | fusionAlg_P_g.Constant3_Value_cy; |
| 30173 | fusionAlg_B.ObjList.vision_28_obj.obj_Heading_STD_V = |
| 30174 | fusionAlg_P_g.Constant4_Value_pp; |
| 30175 | |
| 30176 | /* Selector: '<S223>/Selector21' incorporates: |
| 30177 | * Constant: '<S223>/Constant28' |
| 30178 | */ |
| 30179 | fusionAlg_B.Selector21 = rtu_EyeQ4_Info_st-> |
| 30180 | OBJ_BUS[fusionAlg_P_g.Constant28_Value_g]; |
| 30181 | |
| 30182 | /* DataTypeConversion: '<S253>/Data Type Conversion' */ |
| 30183 | tmp = (real32_T)floor(fusionAlg_B.Selector21.OBJ_ID); |
| 30184 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30185 | tmp = 0.0F; |
| 30186 | } else { |
| 30187 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30188 | } |
| 30189 | |
| 30190 | fusionAlg_B.ObjList.vision_29_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 30191 | (uint32_T)-tmp : (uint32_T)tmp; |
| 30192 | |
| 30193 | /* End of DataTypeConversion: '<S253>/Data Type Conversion' */ |
| 30194 | |
| 30195 | /* Lookup_n-D: '<S514>/1-D Lookup Table' */ |
| 30196 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector21.OBJ_Measuring_Status, |
| 30197 | fusionAlg_P_g.uDLookupTable_bp01Data_kn, 7U); |
| 30198 | fusionAlg_B.Obj_Status_l2 = fusionAlg_P_g.uDLookupTable_tableData_kuw[bpIdx]; |
| 30199 | |
| 30200 | /* DataTypeConversion: '<S514>/Data Type Conversion1' */ |
| 30201 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_l2); |
| 30202 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30203 | tmp = 0.0F; |
| 30204 | } else { |
| 30205 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30206 | } |
| 30207 | |
| 30208 | fusionAlg_B.ObjList.vision_29_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 30209 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 30210 | |
| 30211 | /* End of DataTypeConversion: '<S514>/Data Type Conversion1' */ |
| 30212 | |
| 30213 | /* DataTypeConversion: '<S505>/Data Type Conversion' */ |
| 30214 | tmp = (real32_T)floor(fusionAlg_B.Selector21.OBJ_Object_Age); |
| 30215 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30216 | tmp = 0.0F; |
| 30217 | } else { |
| 30218 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 30219 | } |
| 30220 | |
| 30221 | fusionAlg_B.measureAge_ei = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 30222 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 30223 | |
| 30224 | /* End of DataTypeConversion: '<S505>/Data Type Conversion' */ |
| 30225 | |
| 30226 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' incorporates: |
| 30227 | * Constant: '<S505>/Constant' |
| 30228 | * Constant: '<S505>/Constant1' |
| 30229 | */ |
| 30230 | fusionAlg_B.ObjList.vision_29_obj.obj_stageAge.totalAge = |
| 30231 | fusionAlg_B.measureAge_ei; |
| 30232 | fusionAlg_B.ObjList.vision_29_obj.obj_stageAge.initAge = |
| 30233 | fusionAlg_P_g.Constant_Value_nq; |
| 30234 | fusionAlg_B.ObjList.vision_29_obj.obj_stageAge.measureAge = |
| 30235 | fusionAlg_B.measureAge_ei; |
| 30236 | fusionAlg_B.ObjList.vision_29_obj.obj_stageAge.predictAge = |
| 30237 | fusionAlg_P_g.Constant1_Value_os; |
| 30238 | |
| 30239 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' incorporates: |
| 30240 | * Constant: '<S506>/Constant' |
| 30241 | * Constant: '<S506>/Constant1' |
| 30242 | * Constant: '<S506>/Constant2' |
| 30243 | * Constant: '<S506>/Constant3' |
| 30244 | */ |
| 30245 | fusionAlg_B.ObjList.vision_29_obj.obj_boundary.X1 = |
| 30246 | fusionAlg_P_g.Constant_Value_il; |
| 30247 | fusionAlg_B.ObjList.vision_29_obj.obj_boundary.Y1 = |
| 30248 | fusionAlg_P_g.Constant1_Value_nt; |
| 30249 | fusionAlg_B.ObjList.vision_29_obj.obj_boundary.X2 = |
| 30250 | fusionAlg_P_g.Constant2_Value_jc; |
| 30251 | fusionAlg_B.ObjList.vision_29_obj.obj_boundary.Y2 = |
| 30252 | fusionAlg_P_g.Constant3_Value_al; |
| 30253 | |
| 30254 | /* Lookup_n-D: '<S515>/1-D Lookup Table' */ |
| 30255 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector21.OBJ_Object_Class, |
| 30256 | fusionAlg_P_g.uDLookupTable_bp01Data_ce, 8U); |
| 30257 | fusionAlg_B.Obj_Status_al = fusionAlg_P_g.uDLookupTable_tableData_nl[bpIdx]; |
| 30258 | |
| 30259 | /* DataTypeConversion: '<S515>/Data Type Conversion2' */ |
| 30260 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_al); |
| 30261 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30262 | tmp = 0.0F; |
| 30263 | } else { |
| 30264 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30265 | } |
| 30266 | |
| 30267 | fusionAlg_B.Obj_Type_o = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 30268 | (uint32_T)tmp; |
| 30269 | |
| 30270 | /* End of DataTypeConversion: '<S515>/Data Type Conversion2' */ |
| 30271 | |
| 30272 | /* DataTypeConversion: '<S253>/Data Type Conversion3' */ |
| 30273 | tmp = (real32_T)floor(fusionAlg_B.Selector21.OBJ_Class_Probability); |
| 30274 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30275 | tmp = 0.0F; |
| 30276 | } else { |
| 30277 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30278 | } |
| 30279 | |
| 30280 | fusionAlg_B.Obj_TypeConf_cr3 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp |
| 30281 | : (uint32_T)tmp; |
| 30282 | |
| 30283 | /* End of DataTypeConversion: '<S253>/Data Type Conversion3' */ |
| 30284 | |
| 30285 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' */ |
| 30286 | fusionAlg_B.ObjList.vision_29_obj.obj_coordinate.lateral = |
| 30287 | fusionAlg_B.Selector21.OBJ_Lat_Distance; |
| 30288 | fusionAlg_B.ObjList.vision_29_obj.obj_coordinate.lateralVariance = |
| 30289 | fusionAlg_B.Selector21.OBJ_Lat_Distance_STD; |
| 30290 | fusionAlg_B.ObjList.vision_29_obj.obj_coordinate.longitudinal = |
| 30291 | fusionAlg_B.Selector21.OBJ_Long_Distance; |
| 30292 | fusionAlg_B.ObjList.vision_29_obj.obj_coordinate.longitudinalVariance = |
| 30293 | fusionAlg_B.Selector21.OBJ_Long_Distance_STD; |
| 30294 | |
| 30295 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' */ |
| 30296 | fusionAlg_B.ObjList.vision_29_obj.obj_velocity.Vx = |
| 30297 | fusionAlg_B.Selector21.OBJ_Abs_Long_Velocity; |
| 30298 | fusionAlg_B.ObjList.vision_29_obj.obj_velocity.VxVariance = |
| 30299 | fusionAlg_B.Selector21.OBJ_Abs_Long_Velocity_STD; |
| 30300 | fusionAlg_B.ObjList.vision_29_obj.obj_velocity.Vy = |
| 30301 | fusionAlg_B.Selector21.OBJ_Abs_Lat_Velocity; |
| 30302 | fusionAlg_B.ObjList.vision_29_obj.obj_velocity.VyVariance = |
| 30303 | fusionAlg_B.Selector21.OBJ_Abs_Lat_Velocity_STD; |
| 30304 | |
| 30305 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' */ |
| 30306 | fusionAlg_B.ObjList.vision_29_obj.obj_angleOfCenter.centerAngle = |
| 30307 | fusionAlg_B.Selector21.OBJ_Angle_Mid; |
| 30308 | fusionAlg_B.ObjList.vision_29_obj.obj_angleOfCenter.centerAngleVariance = |
| 30309 | fusionAlg_B.Selector21.OBJ_Angle_Mid_STD; |
| 30310 | |
| 30311 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' */ |
| 30312 | fusionAlg_B.ObjList.vision_29_obj.obj_acceleration.Ax = |
| 30313 | fusionAlg_B.Selector21.OBJ_Abs_Long_Acc; |
| 30314 | fusionAlg_B.ObjList.vision_29_obj.obj_acceleration.AxVariance = |
| 30315 | fusionAlg_B.Selector21.OBJ_Abs_Long_Acc_STD; |
| 30316 | fusionAlg_B.ObjList.vision_29_obj.obj_acceleration.Ay = |
| 30317 | fusionAlg_B.Selector21.OBJ_Abs_Lat_Acc; |
| 30318 | fusionAlg_B.ObjList.vision_29_obj.obj_acceleration.AyVariance = |
| 30319 | fusionAlg_B.Selector21.OBJ_Abs_Lat_Acc_STD; |
| 30320 | |
| 30321 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' */ |
| 30322 | fusionAlg_B.ObjList.vision_29_obj.AyVariance.length = |
| 30323 | fusionAlg_B.Selector21.OBJ_Length; |
| 30324 | fusionAlg_B.ObjList.vision_29_obj.AyVariance.width = |
| 30325 | fusionAlg_B.Selector21.OBJ_Width; |
| 30326 | fusionAlg_B.ObjList.vision_29_obj.AyVariance.height = |
| 30327 | fusionAlg_B.Selector21.OBJ_Height; |
| 30328 | |
| 30329 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' incorporates: |
| 30330 | * Constant: '<S512>/Constant1' |
| 30331 | * Constant: '<S512>/Constant2' |
| 30332 | * Constant: '<S512>/Constant3' |
| 30333 | */ |
| 30334 | fusionAlg_B.ObjList.vision_29_obj.reserved1.reserved0 = |
| 30335 | fusionAlg_P_g.Constant2_Value_ih; |
| 30336 | fusionAlg_B.ObjList.vision_29_obj.reserved1.reserved1 = |
| 30337 | fusionAlg_P_g.Constant1_Value_l2; |
| 30338 | fusionAlg_B.ObjList.vision_29_obj.reserved1.reserved2 = |
| 30339 | fusionAlg_P_g.Constant3_Value_drt; |
| 30340 | |
| 30341 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' incorporates: |
| 30342 | * Constant: '<S513>/Constant5' |
| 30343 | * Constant: '<S513>/Constant6' |
| 30344 | */ |
| 30345 | fusionAlg_B.ObjList.vision_29_obj.reserved2.reserved0 = |
| 30346 | fusionAlg_P_g.Constant5_Value_oh; |
| 30347 | fusionAlg_B.ObjList.vision_29_obj.reserved2.reserved1 = |
| 30348 | fusionAlg_P_g.Constant6_Value_er; |
| 30349 | |
| 30350 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_28' incorporates: |
| 30351 | * Constant: '<S253>/Constant' |
| 30352 | * Constant: '<S253>/Constant1' |
| 30353 | * Constant: '<S253>/Constant2' |
| 30354 | * Constant: '<S253>/Constant3' |
| 30355 | * Constant: '<S253>/Constant4' |
| 30356 | */ |
| 30357 | fusionAlg_B.ObjList.vision_29_obj.obj_type = fusionAlg_B.Obj_Type_o; |
| 30358 | fusionAlg_B.ObjList.vision_29_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_cr3; |
| 30359 | fusionAlg_B.ObjList.vision_29_obj.obj_TTC = fusionAlg_B.Selector21.OBJ_Inv_TTC; |
| 30360 | fusionAlg_B.ObjList.vision_29_obj.obj_TTCVariance = |
| 30361 | fusionAlg_B.Selector21.OBJ_Inv_TTC_STD; |
| 30362 | fusionAlg_B.ObjList.vision_29_obj.obj_existProb = |
| 30363 | fusionAlg_P_g.Constant_Value_oj; |
| 30364 | fusionAlg_B.ObjList.vision_29_obj.obj_angleOfObject = |
| 30365 | fusionAlg_P_g.Constant1_Value_f3q; |
| 30366 | fusionAlg_B.ObjList.vision_29_obj.obj_Heading = |
| 30367 | fusionAlg_B.Selector21.OBJ_Heading; |
| 30368 | fusionAlg_B.ObjList.vision_29_obj.obj_Heading_STD = |
| 30369 | fusionAlg_P_g.Constant2_Value_pr; |
| 30370 | fusionAlg_B.ObjList.vision_29_obj.obj_Heading_V = |
| 30371 | fusionAlg_P_g.Constant3_Value_di; |
| 30372 | fusionAlg_B.ObjList.vision_29_obj.obj_Heading_STD_V = |
| 30373 | fusionAlg_P_g.Constant4_Value_eq; |
| 30374 | |
| 30375 | /* Selector: '<S223>/Selector22' incorporates: |
| 30376 | * Constant: '<S223>/Constant29' |
| 30377 | */ |
| 30378 | fusionAlg_B.Selector22 = rtu_EyeQ4_Info_st-> |
| 30379 | OBJ_BUS[fusionAlg_P_g.Constant29_Value_dd]; |
| 30380 | |
| 30381 | /* DataTypeConversion: '<S255>/Data Type Conversion' */ |
| 30382 | tmp = (real32_T)floor(fusionAlg_B.Selector22.OBJ_ID); |
| 30383 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30384 | tmp = 0.0F; |
| 30385 | } else { |
| 30386 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30387 | } |
| 30388 | |
| 30389 | fusionAlg_B.ObjList.vision_30_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 30390 | (uint32_T)-tmp : (uint32_T)tmp; |
| 30391 | |
| 30392 | /* End of DataTypeConversion: '<S255>/Data Type Conversion' */ |
| 30393 | |
| 30394 | /* Lookup_n-D: '<S536>/1-D Lookup Table' */ |
| 30395 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector22.OBJ_Measuring_Status, |
| 30396 | fusionAlg_P_g.uDLookupTable_bp01Data_mv, 7U); |
| 30397 | fusionAlg_B.Obj_Status_cw = fusionAlg_P_g.uDLookupTable_tableData_fi[bpIdx]; |
| 30398 | |
| 30399 | /* DataTypeConversion: '<S536>/Data Type Conversion1' */ |
| 30400 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_cw); |
| 30401 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30402 | tmp = 0.0F; |
| 30403 | } else { |
| 30404 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30405 | } |
| 30406 | |
| 30407 | fusionAlg_B.ObjList.vision_30_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 30408 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 30409 | |
| 30410 | /* End of DataTypeConversion: '<S536>/Data Type Conversion1' */ |
| 30411 | |
| 30412 | /* DataTypeConversion: '<S527>/Data Type Conversion' */ |
| 30413 | tmp = (real32_T)floor(fusionAlg_B.Selector22.OBJ_Object_Age); |
| 30414 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30415 | tmp = 0.0F; |
| 30416 | } else { |
| 30417 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 30418 | } |
| 30419 | |
| 30420 | fusionAlg_B.measureAge_lj = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 30421 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 30422 | |
| 30423 | /* End of DataTypeConversion: '<S527>/Data Type Conversion' */ |
| 30424 | |
| 30425 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' incorporates: |
| 30426 | * Constant: '<S527>/Constant' |
| 30427 | * Constant: '<S527>/Constant1' |
| 30428 | */ |
| 30429 | fusionAlg_B.ObjList.vision_30_obj.obj_stageAge.totalAge = |
| 30430 | fusionAlg_B.measureAge_lj; |
| 30431 | fusionAlg_B.ObjList.vision_30_obj.obj_stageAge.initAge = |
| 30432 | fusionAlg_P_g.Constant_Value_mv; |
| 30433 | fusionAlg_B.ObjList.vision_30_obj.obj_stageAge.measureAge = |
| 30434 | fusionAlg_B.measureAge_lj; |
| 30435 | fusionAlg_B.ObjList.vision_30_obj.obj_stageAge.predictAge = |
| 30436 | fusionAlg_P_g.Constant1_Value_a2; |
| 30437 | |
| 30438 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' incorporates: |
| 30439 | * Constant: '<S528>/Constant' |
| 30440 | * Constant: '<S528>/Constant1' |
| 30441 | * Constant: '<S528>/Constant2' |
| 30442 | * Constant: '<S528>/Constant3' |
| 30443 | */ |
| 30444 | fusionAlg_B.ObjList.vision_30_obj.obj_boundary.X1 = |
| 30445 | fusionAlg_P_g.Constant_Value_gr; |
| 30446 | fusionAlg_B.ObjList.vision_30_obj.obj_boundary.Y1 = |
| 30447 | fusionAlg_P_g.Constant1_Value_iz; |
| 30448 | fusionAlg_B.ObjList.vision_30_obj.obj_boundary.X2 = |
| 30449 | fusionAlg_P_g.Constant2_Value_og; |
| 30450 | fusionAlg_B.ObjList.vision_30_obj.obj_boundary.Y2 = |
| 30451 | fusionAlg_P_g.Constant3_Value_gr; |
| 30452 | |
| 30453 | /* Lookup_n-D: '<S537>/1-D Lookup Table' */ |
| 30454 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector22.OBJ_Object_Class, |
| 30455 | fusionAlg_P_g.uDLookupTable_bp01Data_pu, 8U); |
| 30456 | fusionAlg_B.Obj_Status_fv = fusionAlg_P_g.uDLookupTable_tableData_dg[bpIdx]; |
| 30457 | |
| 30458 | /* DataTypeConversion: '<S537>/Data Type Conversion2' */ |
| 30459 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_fv); |
| 30460 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30461 | tmp = 0.0F; |
| 30462 | } else { |
| 30463 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30464 | } |
| 30465 | |
| 30466 | fusionAlg_B.Obj_Type_l = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 30467 | (uint32_T)tmp; |
| 30468 | |
| 30469 | /* End of DataTypeConversion: '<S537>/Data Type Conversion2' */ |
| 30470 | |
| 30471 | /* DataTypeConversion: '<S255>/Data Type Conversion3' */ |
| 30472 | tmp = (real32_T)floor(fusionAlg_B.Selector22.OBJ_Class_Probability); |
| 30473 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30474 | tmp = 0.0F; |
| 30475 | } else { |
| 30476 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30477 | } |
| 30478 | |
| 30479 | fusionAlg_B.Obj_TypeConf_gv = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 30480 | (uint32_T)tmp; |
| 30481 | |
| 30482 | /* End of DataTypeConversion: '<S255>/Data Type Conversion3' */ |
| 30483 | |
| 30484 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' */ |
| 30485 | fusionAlg_B.ObjList.vision_30_obj.obj_coordinate.lateral = |
| 30486 | fusionAlg_B.Selector22.OBJ_Lat_Distance; |
| 30487 | fusionAlg_B.ObjList.vision_30_obj.obj_coordinate.lateralVariance = |
| 30488 | fusionAlg_B.Selector22.OBJ_Lat_Distance_STD; |
| 30489 | fusionAlg_B.ObjList.vision_30_obj.obj_coordinate.longitudinal = |
| 30490 | fusionAlg_B.Selector22.OBJ_Long_Distance; |
| 30491 | fusionAlg_B.ObjList.vision_30_obj.obj_coordinate.longitudinalVariance = |
| 30492 | fusionAlg_B.Selector22.OBJ_Long_Distance_STD; |
| 30493 | |
| 30494 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' */ |
| 30495 | fusionAlg_B.ObjList.vision_30_obj.obj_velocity.Vx = |
| 30496 | fusionAlg_B.Selector22.OBJ_Abs_Long_Velocity; |
| 30497 | fusionAlg_B.ObjList.vision_30_obj.obj_velocity.VxVariance = |
| 30498 | fusionAlg_B.Selector22.OBJ_Abs_Long_Velocity_STD; |
| 30499 | fusionAlg_B.ObjList.vision_30_obj.obj_velocity.Vy = |
| 30500 | fusionAlg_B.Selector22.OBJ_Abs_Lat_Velocity; |
| 30501 | fusionAlg_B.ObjList.vision_30_obj.obj_velocity.VyVariance = |
| 30502 | fusionAlg_B.Selector22.OBJ_Abs_Lat_Velocity_STD; |
| 30503 | |
| 30504 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' */ |
| 30505 | fusionAlg_B.ObjList.vision_30_obj.obj_angleOfCenter.centerAngle = |
| 30506 | fusionAlg_B.Selector22.OBJ_Angle_Mid; |
| 30507 | fusionAlg_B.ObjList.vision_30_obj.obj_angleOfCenter.centerAngleVariance = |
| 30508 | fusionAlg_B.Selector22.OBJ_Angle_Mid_STD; |
| 30509 | |
| 30510 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' */ |
| 30511 | fusionAlg_B.ObjList.vision_30_obj.obj_acceleration.Ax = |
| 30512 | fusionAlg_B.Selector22.OBJ_Abs_Long_Acc; |
| 30513 | fusionAlg_B.ObjList.vision_30_obj.obj_acceleration.AxVariance = |
| 30514 | fusionAlg_B.Selector22.OBJ_Abs_Long_Acc_STD; |
| 30515 | fusionAlg_B.ObjList.vision_30_obj.obj_acceleration.Ay = |
| 30516 | fusionAlg_B.Selector22.OBJ_Abs_Lat_Acc; |
| 30517 | fusionAlg_B.ObjList.vision_30_obj.obj_acceleration.AyVariance = |
| 30518 | fusionAlg_B.Selector22.OBJ_Abs_Lat_Acc_STD; |
| 30519 | |
| 30520 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' */ |
| 30521 | fusionAlg_B.ObjList.vision_30_obj.AyVariance.length = |
| 30522 | fusionAlg_B.Selector22.OBJ_Length; |
| 30523 | fusionAlg_B.ObjList.vision_30_obj.AyVariance.width = |
| 30524 | fusionAlg_B.Selector22.OBJ_Width; |
| 30525 | fusionAlg_B.ObjList.vision_30_obj.AyVariance.height = |
| 30526 | fusionAlg_B.Selector22.OBJ_Height; |
| 30527 | |
| 30528 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' incorporates: |
| 30529 | * Constant: '<S534>/Constant1' |
| 30530 | * Constant: '<S534>/Constant2' |
| 30531 | * Constant: '<S534>/Constant3' |
| 30532 | */ |
| 30533 | fusionAlg_B.ObjList.vision_30_obj.reserved1.reserved0 = |
| 30534 | fusionAlg_P_g.Constant2_Value_mv; |
| 30535 | fusionAlg_B.ObjList.vision_30_obj.reserved1.reserved1 = |
| 30536 | fusionAlg_P_g.Constant1_Value_lhb; |
| 30537 | fusionAlg_B.ObjList.vision_30_obj.reserved1.reserved2 = |
| 30538 | fusionAlg_P_g.Constant3_Value_j5; |
| 30539 | |
| 30540 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' incorporates: |
| 30541 | * Constant: '<S535>/Constant5' |
| 30542 | * Constant: '<S535>/Constant6' |
| 30543 | */ |
| 30544 | fusionAlg_B.ObjList.vision_30_obj.reserved2.reserved0 = |
| 30545 | fusionAlg_P_g.Constant5_Value_ft; |
| 30546 | fusionAlg_B.ObjList.vision_30_obj.reserved2.reserved1 = |
| 30547 | fusionAlg_P_g.Constant6_Value_km; |
| 30548 | |
| 30549 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_29' incorporates: |
| 30550 | * Constant: '<S255>/Constant' |
| 30551 | * Constant: '<S255>/Constant1' |
| 30552 | * Constant: '<S255>/Constant2' |
| 30553 | * Constant: '<S255>/Constant3' |
| 30554 | * Constant: '<S255>/Constant4' |
| 30555 | */ |
| 30556 | fusionAlg_B.ObjList.vision_30_obj.obj_type = fusionAlg_B.Obj_Type_l; |
| 30557 | fusionAlg_B.ObjList.vision_30_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_gv; |
| 30558 | fusionAlg_B.ObjList.vision_30_obj.obj_TTC = fusionAlg_B.Selector22.OBJ_Inv_TTC; |
| 30559 | fusionAlg_B.ObjList.vision_30_obj.obj_TTCVariance = |
| 30560 | fusionAlg_B.Selector22.OBJ_Inv_TTC_STD; |
| 30561 | fusionAlg_B.ObjList.vision_30_obj.obj_existProb = |
| 30562 | fusionAlg_P_g.Constant_Value_o0; |
| 30563 | fusionAlg_B.ObjList.vision_30_obj.obj_angleOfObject = |
| 30564 | fusionAlg_P_g.Constant1_Value_ez; |
| 30565 | fusionAlg_B.ObjList.vision_30_obj.obj_Heading = |
| 30566 | fusionAlg_B.Selector22.OBJ_Heading; |
| 30567 | fusionAlg_B.ObjList.vision_30_obj.obj_Heading_STD = |
| 30568 | fusionAlg_P_g.Constant2_Value_kim; |
| 30569 | fusionAlg_B.ObjList.vision_30_obj.obj_Heading_V = |
| 30570 | fusionAlg_P_g.Constant3_Value_ky; |
| 30571 | fusionAlg_B.ObjList.vision_30_obj.obj_Heading_STD_V = |
| 30572 | fusionAlg_P_g.Constant4_Value_ict; |
| 30573 | |
| 30574 | /* Selector: '<S223>/Selector23' incorporates: |
| 30575 | * Constant: '<S223>/Constant30' |
| 30576 | */ |
| 30577 | fusionAlg_B.Selector23 = rtu_EyeQ4_Info_st-> |
| 30578 | OBJ_BUS[fusionAlg_P_g.Constant30_Value_fd]; |
| 30579 | |
| 30580 | /* DataTypeConversion: '<S256>/Data Type Conversion' */ |
| 30581 | tmp = (real32_T)floor(fusionAlg_B.Selector23.OBJ_ID); |
| 30582 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30583 | tmp = 0.0F; |
| 30584 | } else { |
| 30585 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30586 | } |
| 30587 | |
| 30588 | fusionAlg_B.ObjList.vision_31_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 30589 | (uint32_T)-tmp : (uint32_T)tmp; |
| 30590 | |
| 30591 | /* End of DataTypeConversion: '<S256>/Data Type Conversion' */ |
| 30592 | |
| 30593 | /* Lookup_n-D: '<S547>/1-D Lookup Table' */ |
| 30594 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector23.OBJ_Measuring_Status, |
| 30595 | fusionAlg_P_g.uDLookupTable_bp01Data_ht, 7U); |
| 30596 | fusionAlg_B.Obj_Status_bow = fusionAlg_P_g.uDLookupTable_tableData_p5[bpIdx]; |
| 30597 | |
| 30598 | /* DataTypeConversion: '<S547>/Data Type Conversion1' */ |
| 30599 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_bow); |
| 30600 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30601 | tmp = 0.0F; |
| 30602 | } else { |
| 30603 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30604 | } |
| 30605 | |
| 30606 | fusionAlg_B.ObjList.vision_31_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 30607 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 30608 | |
| 30609 | /* End of DataTypeConversion: '<S547>/Data Type Conversion1' */ |
| 30610 | |
| 30611 | /* DataTypeConversion: '<S538>/Data Type Conversion' */ |
| 30612 | tmp = (real32_T)floor(fusionAlg_B.Selector23.OBJ_Object_Age); |
| 30613 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30614 | tmp = 0.0F; |
| 30615 | } else { |
| 30616 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 30617 | } |
| 30618 | |
| 30619 | fusionAlg_B.measureAge_p = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 30620 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 30621 | |
| 30622 | /* End of DataTypeConversion: '<S538>/Data Type Conversion' */ |
| 30623 | |
| 30624 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' incorporates: |
| 30625 | * Constant: '<S538>/Constant' |
| 30626 | * Constant: '<S538>/Constant1' |
| 30627 | */ |
| 30628 | fusionAlg_B.ObjList.vision_31_obj.obj_stageAge.totalAge = |
| 30629 | fusionAlg_B.measureAge_p; |
| 30630 | fusionAlg_B.ObjList.vision_31_obj.obj_stageAge.initAge = |
| 30631 | fusionAlg_P_g.Constant_Value_as; |
| 30632 | fusionAlg_B.ObjList.vision_31_obj.obj_stageAge.measureAge = |
| 30633 | fusionAlg_B.measureAge_p; |
| 30634 | fusionAlg_B.ObjList.vision_31_obj.obj_stageAge.predictAge = |
| 30635 | fusionAlg_P_g.Constant1_Value_kn; |
| 30636 | |
| 30637 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' incorporates: |
| 30638 | * Constant: '<S539>/Constant' |
| 30639 | * Constant: '<S539>/Constant1' |
| 30640 | * Constant: '<S539>/Constant2' |
| 30641 | * Constant: '<S539>/Constant3' |
| 30642 | */ |
| 30643 | fusionAlg_B.ObjList.vision_31_obj.obj_boundary.X1 = |
| 30644 | fusionAlg_P_g.Constant_Value_d2; |
| 30645 | fusionAlg_B.ObjList.vision_31_obj.obj_boundary.Y1 = |
| 30646 | fusionAlg_P_g.Constant1_Value_bg; |
| 30647 | fusionAlg_B.ObjList.vision_31_obj.obj_boundary.X2 = |
| 30648 | fusionAlg_P_g.Constant2_Value_gkz; |
| 30649 | fusionAlg_B.ObjList.vision_31_obj.obj_boundary.Y2 = |
| 30650 | fusionAlg_P_g.Constant3_Value_i2; |
| 30651 | |
| 30652 | /* Lookup_n-D: '<S548>/1-D Lookup Table' */ |
| 30653 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector23.OBJ_Object_Class, |
| 30654 | fusionAlg_P_g.uDLookupTable_bp01Data_oh, 8U); |
| 30655 | fusionAlg_B.Obj_Status_ny = fusionAlg_P_g.uDLookupTable_tableData_ec[bpIdx]; |
| 30656 | |
| 30657 | /* DataTypeConversion: '<S548>/Data Type Conversion2' */ |
| 30658 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ny); |
| 30659 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30660 | tmp = 0.0F; |
| 30661 | } else { |
| 30662 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30663 | } |
| 30664 | |
| 30665 | fusionAlg_B.Obj_Type_py = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 30666 | (uint32_T)tmp; |
| 30667 | |
| 30668 | /* End of DataTypeConversion: '<S548>/Data Type Conversion2' */ |
| 30669 | |
| 30670 | /* DataTypeConversion: '<S256>/Data Type Conversion3' */ |
| 30671 | tmp = (real32_T)floor(fusionAlg_B.Selector23.OBJ_Class_Probability); |
| 30672 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30673 | tmp = 0.0F; |
| 30674 | } else { |
| 30675 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30676 | } |
| 30677 | |
| 30678 | fusionAlg_B.Obj_TypeConf_lgq = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp |
| 30679 | : (uint32_T)tmp; |
| 30680 | |
| 30681 | /* End of DataTypeConversion: '<S256>/Data Type Conversion3' */ |
| 30682 | |
| 30683 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' */ |
| 30684 | fusionAlg_B.ObjList.vision_31_obj.obj_coordinate.lateral = |
| 30685 | fusionAlg_B.Selector23.OBJ_Lat_Distance; |
| 30686 | fusionAlg_B.ObjList.vision_31_obj.obj_coordinate.lateralVariance = |
| 30687 | fusionAlg_B.Selector23.OBJ_Lat_Distance_STD; |
| 30688 | fusionAlg_B.ObjList.vision_31_obj.obj_coordinate.longitudinal = |
| 30689 | fusionAlg_B.Selector23.OBJ_Long_Distance; |
| 30690 | fusionAlg_B.ObjList.vision_31_obj.obj_coordinate.longitudinalVariance = |
| 30691 | fusionAlg_B.Selector23.OBJ_Long_Distance_STD; |
| 30692 | |
| 30693 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' */ |
| 30694 | fusionAlg_B.ObjList.vision_31_obj.obj_velocity.Vx = |
| 30695 | fusionAlg_B.Selector23.OBJ_Abs_Long_Velocity; |
| 30696 | fusionAlg_B.ObjList.vision_31_obj.obj_velocity.VxVariance = |
| 30697 | fusionAlg_B.Selector23.OBJ_Abs_Long_Velocity_STD; |
| 30698 | fusionAlg_B.ObjList.vision_31_obj.obj_velocity.Vy = |
| 30699 | fusionAlg_B.Selector23.OBJ_Abs_Lat_Velocity; |
| 30700 | fusionAlg_B.ObjList.vision_31_obj.obj_velocity.VyVariance = |
| 30701 | fusionAlg_B.Selector23.OBJ_Abs_Lat_Velocity_STD; |
| 30702 | |
| 30703 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' */ |
| 30704 | fusionAlg_B.ObjList.vision_31_obj.obj_angleOfCenter.centerAngle = |
| 30705 | fusionAlg_B.Selector23.OBJ_Angle_Mid; |
| 30706 | fusionAlg_B.ObjList.vision_31_obj.obj_angleOfCenter.centerAngleVariance = |
| 30707 | fusionAlg_B.Selector23.OBJ_Angle_Mid_STD; |
| 30708 | |
| 30709 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' */ |
| 30710 | fusionAlg_B.ObjList.vision_31_obj.obj_acceleration.Ax = |
| 30711 | fusionAlg_B.Selector23.OBJ_Abs_Long_Acc; |
| 30712 | fusionAlg_B.ObjList.vision_31_obj.obj_acceleration.AxVariance = |
| 30713 | fusionAlg_B.Selector23.OBJ_Abs_Long_Acc_STD; |
| 30714 | fusionAlg_B.ObjList.vision_31_obj.obj_acceleration.Ay = |
| 30715 | fusionAlg_B.Selector23.OBJ_Abs_Lat_Acc; |
| 30716 | fusionAlg_B.ObjList.vision_31_obj.obj_acceleration.AyVariance = |
| 30717 | fusionAlg_B.Selector23.OBJ_Abs_Lat_Acc_STD; |
| 30718 | |
| 30719 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' */ |
| 30720 | fusionAlg_B.ObjList.vision_31_obj.AyVariance.length = |
| 30721 | fusionAlg_B.Selector23.OBJ_Length; |
| 30722 | fusionAlg_B.ObjList.vision_31_obj.AyVariance.width = |
| 30723 | fusionAlg_B.Selector23.OBJ_Width; |
| 30724 | fusionAlg_B.ObjList.vision_31_obj.AyVariance.height = |
| 30725 | fusionAlg_B.Selector23.OBJ_Height; |
| 30726 | |
| 30727 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' incorporates: |
| 30728 | * Constant: '<S545>/Constant1' |
| 30729 | * Constant: '<S545>/Constant2' |
| 30730 | * Constant: '<S545>/Constant3' |
| 30731 | */ |
| 30732 | fusionAlg_B.ObjList.vision_31_obj.reserved1.reserved0 = |
| 30733 | fusionAlg_P_g.Constant2_Value_jm; |
| 30734 | fusionAlg_B.ObjList.vision_31_obj.reserved1.reserved1 = |
| 30735 | fusionAlg_P_g.Constant1_Value_moe; |
| 30736 | fusionAlg_B.ObjList.vision_31_obj.reserved1.reserved2 = |
| 30737 | fusionAlg_P_g.Constant3_Value_p5x; |
| 30738 | |
| 30739 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' incorporates: |
| 30740 | * Constant: '<S546>/Constant5' |
| 30741 | * Constant: '<S546>/Constant6' |
| 30742 | */ |
| 30743 | fusionAlg_B.ObjList.vision_31_obj.reserved2.reserved0 = |
| 30744 | fusionAlg_P_g.Constant5_Value_he; |
| 30745 | fusionAlg_B.ObjList.vision_31_obj.reserved2.reserved1 = |
| 30746 | fusionAlg_P_g.Constant6_Value_b5; |
| 30747 | |
| 30748 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_30' incorporates: |
| 30749 | * Constant: '<S256>/Constant' |
| 30750 | * Constant: '<S256>/Constant1' |
| 30751 | * Constant: '<S256>/Constant2' |
| 30752 | * Constant: '<S256>/Constant3' |
| 30753 | * Constant: '<S256>/Constant4' |
| 30754 | */ |
| 30755 | fusionAlg_B.ObjList.vision_31_obj.obj_type = fusionAlg_B.Obj_Type_py; |
| 30756 | fusionAlg_B.ObjList.vision_31_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_lgq; |
| 30757 | fusionAlg_B.ObjList.vision_31_obj.obj_TTC = fusionAlg_B.Selector23.OBJ_Inv_TTC; |
| 30758 | fusionAlg_B.ObjList.vision_31_obj.obj_TTCVariance = |
| 30759 | fusionAlg_B.Selector23.OBJ_Inv_TTC_STD; |
| 30760 | fusionAlg_B.ObjList.vision_31_obj.obj_existProb = |
| 30761 | fusionAlg_P_g.Constant_Value_nb; |
| 30762 | fusionAlg_B.ObjList.vision_31_obj.obj_angleOfObject = |
| 30763 | fusionAlg_P_g.Constant1_Value_cli; |
| 30764 | fusionAlg_B.ObjList.vision_31_obj.obj_Heading = |
| 30765 | fusionAlg_B.Selector23.OBJ_Heading; |
| 30766 | fusionAlg_B.ObjList.vision_31_obj.obj_Heading_STD = |
| 30767 | fusionAlg_P_g.Constant2_Value_pl; |
| 30768 | fusionAlg_B.ObjList.vision_31_obj.obj_Heading_V = |
| 30769 | fusionAlg_P_g.Constant3_Value_jn; |
| 30770 | fusionAlg_B.ObjList.vision_31_obj.obj_Heading_STD_V = |
| 30771 | fusionAlg_P_g.Constant4_Value_nsk; |
| 30772 | |
| 30773 | /* Selector: '<S223>/Selector31' incorporates: |
| 30774 | * Constant: '<S223>/Constant31' |
| 30775 | */ |
| 30776 | fusionAlg_B.Selector31 = rtu_EyeQ4_Info_st-> |
| 30777 | OBJ_BUS[fusionAlg_P_g.Constant31_Value_h]; |
| 30778 | |
| 30779 | /* DataTypeConversion: '<S257>/Data Type Conversion' */ |
| 30780 | tmp = (real32_T)floor(fusionAlg_B.Selector31.OBJ_ID); |
| 30781 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30782 | tmp = 0.0F; |
| 30783 | } else { |
| 30784 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30785 | } |
| 30786 | |
| 30787 | fusionAlg_B.ObjList.vision_32_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 30788 | (uint32_T)-tmp : (uint32_T)tmp; |
| 30789 | |
| 30790 | /* End of DataTypeConversion: '<S257>/Data Type Conversion' */ |
| 30791 | |
| 30792 | /* Lookup_n-D: '<S558>/1-D Lookup Table' */ |
| 30793 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector31.OBJ_Measuring_Status, |
| 30794 | fusionAlg_P_g.uDLookupTable_bp01Data_cf, 7U); |
| 30795 | fusionAlg_B.Obj_Status_jl = fusionAlg_P_g.uDLookupTable_tableData_gi[bpIdx]; |
| 30796 | |
| 30797 | /* DataTypeConversion: '<S558>/Data Type Conversion1' */ |
| 30798 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_jl); |
| 30799 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30800 | tmp = 0.0F; |
| 30801 | } else { |
| 30802 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30803 | } |
| 30804 | |
| 30805 | fusionAlg_B.ObjList.vision_32_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 30806 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 30807 | |
| 30808 | /* End of DataTypeConversion: '<S558>/Data Type Conversion1' */ |
| 30809 | |
| 30810 | /* DataTypeConversion: '<S549>/Data Type Conversion' */ |
| 30811 | tmp = (real32_T)floor(fusionAlg_B.Selector31.OBJ_Object_Age); |
| 30812 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30813 | tmp = 0.0F; |
| 30814 | } else { |
| 30815 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 30816 | } |
| 30817 | |
| 30818 | fusionAlg_B.measureAge_j0 = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 30819 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 30820 | |
| 30821 | /* End of DataTypeConversion: '<S549>/Data Type Conversion' */ |
| 30822 | |
| 30823 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' incorporates: |
| 30824 | * Constant: '<S549>/Constant' |
| 30825 | * Constant: '<S549>/Constant1' |
| 30826 | */ |
| 30827 | fusionAlg_B.ObjList.vision_32_obj.obj_stageAge.totalAge = |
| 30828 | fusionAlg_B.measureAge_j0; |
| 30829 | fusionAlg_B.ObjList.vision_32_obj.obj_stageAge.initAge = |
| 30830 | fusionAlg_P_g.Constant_Value_dm; |
| 30831 | fusionAlg_B.ObjList.vision_32_obj.obj_stageAge.measureAge = |
| 30832 | fusionAlg_B.measureAge_j0; |
| 30833 | fusionAlg_B.ObjList.vision_32_obj.obj_stageAge.predictAge = |
| 30834 | fusionAlg_P_g.Constant1_Value_b2; |
| 30835 | |
| 30836 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' incorporates: |
| 30837 | * Constant: '<S550>/Constant' |
| 30838 | * Constant: '<S550>/Constant1' |
| 30839 | * Constant: '<S550>/Constant2' |
| 30840 | * Constant: '<S550>/Constant3' |
| 30841 | */ |
| 30842 | fusionAlg_B.ObjList.vision_32_obj.obj_boundary.X1 = |
| 30843 | fusionAlg_P_g.Constant_Value_dk; |
| 30844 | fusionAlg_B.ObjList.vision_32_obj.obj_boundary.Y1 = |
| 30845 | fusionAlg_P_g.Constant1_Value_jn; |
| 30846 | fusionAlg_B.ObjList.vision_32_obj.obj_boundary.X2 = |
| 30847 | fusionAlg_P_g.Constant2_Value_bj2; |
| 30848 | fusionAlg_B.ObjList.vision_32_obj.obj_boundary.Y2 = |
| 30849 | fusionAlg_P_g.Constant3_Value_kyu; |
| 30850 | |
| 30851 | /* Lookup_n-D: '<S559>/1-D Lookup Table' */ |
| 30852 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector31.OBJ_Object_Class, |
| 30853 | fusionAlg_P_g.uDLookupTable_bp01Data_og, 8U); |
| 30854 | fusionAlg_B.Obj_Status_ld = fusionAlg_P_g.uDLookupTable_tableData_l1[bpIdx]; |
| 30855 | |
| 30856 | /* DataTypeConversion: '<S559>/Data Type Conversion2' */ |
| 30857 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ld); |
| 30858 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30859 | tmp = 0.0F; |
| 30860 | } else { |
| 30861 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30862 | } |
| 30863 | |
| 30864 | fusionAlg_B.Obj_Type_fw = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 30865 | (uint32_T)tmp; |
| 30866 | |
| 30867 | /* End of DataTypeConversion: '<S559>/Data Type Conversion2' */ |
| 30868 | |
| 30869 | /* DataTypeConversion: '<S257>/Data Type Conversion3' */ |
| 30870 | tmp = (real32_T)floor(fusionAlg_B.Selector31.OBJ_Class_Probability); |
| 30871 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30872 | tmp = 0.0F; |
| 30873 | } else { |
| 30874 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30875 | } |
| 30876 | |
| 30877 | fusionAlg_B.Obj_TypeConf_gw = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 30878 | (uint32_T)tmp; |
| 30879 | |
| 30880 | /* End of DataTypeConversion: '<S257>/Data Type Conversion3' */ |
| 30881 | |
| 30882 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' */ |
| 30883 | fusionAlg_B.ObjList.vision_32_obj.obj_coordinate.lateral = |
| 30884 | fusionAlg_B.Selector31.OBJ_Lat_Distance; |
| 30885 | fusionAlg_B.ObjList.vision_32_obj.obj_coordinate.lateralVariance = |
| 30886 | fusionAlg_B.Selector31.OBJ_Lat_Distance_STD; |
| 30887 | fusionAlg_B.ObjList.vision_32_obj.obj_coordinate.longitudinal = |
| 30888 | fusionAlg_B.Selector31.OBJ_Long_Distance; |
| 30889 | fusionAlg_B.ObjList.vision_32_obj.obj_coordinate.longitudinalVariance = |
| 30890 | fusionAlg_B.Selector31.OBJ_Long_Distance_STD; |
| 30891 | |
| 30892 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' */ |
| 30893 | fusionAlg_B.ObjList.vision_32_obj.obj_velocity.Vx = |
| 30894 | fusionAlg_B.Selector31.OBJ_Abs_Long_Velocity; |
| 30895 | fusionAlg_B.ObjList.vision_32_obj.obj_velocity.VxVariance = |
| 30896 | fusionAlg_B.Selector31.OBJ_Abs_Long_Velocity_STD; |
| 30897 | fusionAlg_B.ObjList.vision_32_obj.obj_velocity.Vy = |
| 30898 | fusionAlg_B.Selector31.OBJ_Abs_Lat_Velocity; |
| 30899 | fusionAlg_B.ObjList.vision_32_obj.obj_velocity.VyVariance = |
| 30900 | fusionAlg_B.Selector31.OBJ_Abs_Lat_Velocity_STD; |
| 30901 | |
| 30902 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' */ |
| 30903 | fusionAlg_B.ObjList.vision_32_obj.obj_angleOfCenter.centerAngle = |
| 30904 | fusionAlg_B.Selector31.OBJ_Angle_Mid; |
| 30905 | fusionAlg_B.ObjList.vision_32_obj.obj_angleOfCenter.centerAngleVariance = |
| 30906 | fusionAlg_B.Selector31.OBJ_Angle_Mid_STD; |
| 30907 | |
| 30908 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' */ |
| 30909 | fusionAlg_B.ObjList.vision_32_obj.obj_acceleration.Ax = |
| 30910 | fusionAlg_B.Selector31.OBJ_Abs_Long_Acc; |
| 30911 | fusionAlg_B.ObjList.vision_32_obj.obj_acceleration.AxVariance = |
| 30912 | fusionAlg_B.Selector31.OBJ_Abs_Long_Acc_STD; |
| 30913 | fusionAlg_B.ObjList.vision_32_obj.obj_acceleration.Ay = |
| 30914 | fusionAlg_B.Selector31.OBJ_Abs_Lat_Acc; |
| 30915 | fusionAlg_B.ObjList.vision_32_obj.obj_acceleration.AyVariance = |
| 30916 | fusionAlg_B.Selector31.OBJ_Abs_Lat_Acc_STD; |
| 30917 | |
| 30918 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' */ |
| 30919 | fusionAlg_B.ObjList.vision_32_obj.AyVariance.length = |
| 30920 | fusionAlg_B.Selector31.OBJ_Length; |
| 30921 | fusionAlg_B.ObjList.vision_32_obj.AyVariance.width = |
| 30922 | fusionAlg_B.Selector31.OBJ_Width; |
| 30923 | fusionAlg_B.ObjList.vision_32_obj.AyVariance.height = |
| 30924 | fusionAlg_B.Selector31.OBJ_Height; |
| 30925 | |
| 30926 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' incorporates: |
| 30927 | * Constant: '<S556>/Constant1' |
| 30928 | * Constant: '<S556>/Constant2' |
| 30929 | * Constant: '<S556>/Constant3' |
| 30930 | */ |
| 30931 | fusionAlg_B.ObjList.vision_32_obj.reserved1.reserved0 = |
| 30932 | fusionAlg_P_g.Constant2_Value_bsi; |
| 30933 | fusionAlg_B.ObjList.vision_32_obj.reserved1.reserved1 = |
| 30934 | fusionAlg_P_g.Constant1_Value_og; |
| 30935 | fusionAlg_B.ObjList.vision_32_obj.reserved1.reserved2 = |
| 30936 | fusionAlg_P_g.Constant3_Value_if; |
| 30937 | |
| 30938 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' incorporates: |
| 30939 | * Constant: '<S557>/Constant5' |
| 30940 | * Constant: '<S557>/Constant6' |
| 30941 | */ |
| 30942 | fusionAlg_B.ObjList.vision_32_obj.reserved2.reserved0 = |
| 30943 | fusionAlg_P_g.Constant5_Value_nb; |
| 30944 | fusionAlg_B.ObjList.vision_32_obj.reserved2.reserved1 = |
| 30945 | fusionAlg_P_g.Constant6_Value_lu; |
| 30946 | |
| 30947 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_31' incorporates: |
| 30948 | * Constant: '<S257>/Constant' |
| 30949 | * Constant: '<S257>/Constant1' |
| 30950 | * Constant: '<S257>/Constant2' |
| 30951 | * Constant: '<S257>/Constant3' |
| 30952 | * Constant: '<S257>/Constant4' |
| 30953 | */ |
| 30954 | fusionAlg_B.ObjList.vision_32_obj.obj_type = fusionAlg_B.Obj_Type_fw; |
| 30955 | fusionAlg_B.ObjList.vision_32_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_gw; |
| 30956 | fusionAlg_B.ObjList.vision_32_obj.obj_TTC = fusionAlg_B.Selector31.OBJ_Inv_TTC; |
| 30957 | fusionAlg_B.ObjList.vision_32_obj.obj_TTCVariance = |
| 30958 | fusionAlg_B.Selector31.OBJ_Inv_TTC_STD; |
| 30959 | fusionAlg_B.ObjList.vision_32_obj.obj_existProb = |
| 30960 | fusionAlg_P_g.Constant_Value_d; |
| 30961 | fusionAlg_B.ObjList.vision_32_obj.obj_angleOfObject = |
| 30962 | fusionAlg_P_g.Constant1_Value_e4; |
| 30963 | fusionAlg_B.ObjList.vision_32_obj.obj_Heading = |
| 30964 | fusionAlg_B.Selector31.OBJ_Heading; |
| 30965 | fusionAlg_B.ObjList.vision_32_obj.obj_Heading_STD = |
| 30966 | fusionAlg_P_g.Constant2_Value_ld; |
| 30967 | fusionAlg_B.ObjList.vision_32_obj.obj_Heading_V = |
| 30968 | fusionAlg_P_g.Constant3_Value_kyj; |
| 30969 | fusionAlg_B.ObjList.vision_32_obj.obj_Heading_STD_V = |
| 30970 | fusionAlg_P_g.Constant4_Value_e1; |
| 30971 | |
| 30972 | /* Selector: '<S223>/Selector32' incorporates: |
| 30973 | * Constant: '<S223>/Constant32' |
| 30974 | */ |
| 30975 | fusionAlg_B.Selector32 = rtu_EyeQ4_Info_st-> |
| 30976 | OBJ_BUS[fusionAlg_P_g.Constant32_Value_i]; |
| 30977 | |
| 30978 | /* DataTypeConversion: '<S258>/Data Type Conversion' */ |
| 30979 | tmp = (real32_T)floor(fusionAlg_B.Selector32.OBJ_ID); |
| 30980 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30981 | tmp = 0.0F; |
| 30982 | } else { |
| 30983 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 30984 | } |
| 30985 | |
| 30986 | fusionAlg_B.ObjList.vision_33_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 30987 | (uint32_T)-tmp : (uint32_T)tmp; |
| 30988 | |
| 30989 | /* End of DataTypeConversion: '<S258>/Data Type Conversion' */ |
| 30990 | |
| 30991 | /* Lookup_n-D: '<S569>/1-D Lookup Table' */ |
| 30992 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector32.OBJ_Measuring_Status, |
| 30993 | fusionAlg_P_g.uDLookupTable_bp01Data_n1, 7U); |
| 30994 | fusionAlg_B.Obj_Status_pa = fusionAlg_P_g.uDLookupTable_tableData_hi[bpIdx]; |
| 30995 | |
| 30996 | /* DataTypeConversion: '<S569>/Data Type Conversion1' */ |
| 30997 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_pa); |
| 30998 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 30999 | tmp = 0.0F; |
| 31000 | } else { |
| 31001 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31002 | } |
| 31003 | |
| 31004 | fusionAlg_B.ObjList.vision_33_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 31005 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 31006 | |
| 31007 | /* End of DataTypeConversion: '<S569>/Data Type Conversion1' */ |
| 31008 | |
| 31009 | /* DataTypeConversion: '<S560>/Data Type Conversion' */ |
| 31010 | tmp = (real32_T)floor(fusionAlg_B.Selector32.OBJ_Object_Age); |
| 31011 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31012 | tmp = 0.0F; |
| 31013 | } else { |
| 31014 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 31015 | } |
| 31016 | |
| 31017 | fusionAlg_B.measureAge_jn = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 31018 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 31019 | |
| 31020 | /* End of DataTypeConversion: '<S560>/Data Type Conversion' */ |
| 31021 | |
| 31022 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' incorporates: |
| 31023 | * Constant: '<S560>/Constant' |
| 31024 | * Constant: '<S560>/Constant1' |
| 31025 | */ |
| 31026 | fusionAlg_B.ObjList.vision_33_obj.obj_stageAge.totalAge = |
| 31027 | fusionAlg_B.measureAge_jn; |
| 31028 | fusionAlg_B.ObjList.vision_33_obj.obj_stageAge.initAge = |
| 31029 | fusionAlg_P_g.Constant_Value_pm; |
| 31030 | fusionAlg_B.ObjList.vision_33_obj.obj_stageAge.measureAge = |
| 31031 | fusionAlg_B.measureAge_jn; |
| 31032 | fusionAlg_B.ObjList.vision_33_obj.obj_stageAge.predictAge = |
| 31033 | fusionAlg_P_g.Constant1_Value_h4; |
| 31034 | |
| 31035 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' incorporates: |
| 31036 | * Constant: '<S561>/Constant' |
| 31037 | * Constant: '<S561>/Constant1' |
| 31038 | * Constant: '<S561>/Constant2' |
| 31039 | * Constant: '<S561>/Constant3' |
| 31040 | */ |
| 31041 | fusionAlg_B.ObjList.vision_33_obj.obj_boundary.X1 = |
| 31042 | fusionAlg_P_g.Constant_Value_ph; |
| 31043 | fusionAlg_B.ObjList.vision_33_obj.obj_boundary.Y1 = |
| 31044 | fusionAlg_P_g.Constant1_Value_aq; |
| 31045 | fusionAlg_B.ObjList.vision_33_obj.obj_boundary.X2 = |
| 31046 | fusionAlg_P_g.Constant2_Value_kn; |
| 31047 | fusionAlg_B.ObjList.vision_33_obj.obj_boundary.Y2 = |
| 31048 | fusionAlg_P_g.Constant3_Value_m4; |
| 31049 | |
| 31050 | /* Lookup_n-D: '<S570>/1-D Lookup Table' */ |
| 31051 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector32.OBJ_Object_Class, |
| 31052 | fusionAlg_P_g.uDLookupTable_bp01Data_dj, 8U); |
| 31053 | fusionAlg_B.Obj_Status_ju = fusionAlg_P_g.uDLookupTable_tableData_j0[bpIdx]; |
| 31054 | |
| 31055 | /* DataTypeConversion: '<S570>/Data Type Conversion2' */ |
| 31056 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ju); |
| 31057 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31058 | tmp = 0.0F; |
| 31059 | } else { |
| 31060 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31061 | } |
| 31062 | |
| 31063 | fusionAlg_B.Obj_Type_il = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31064 | (uint32_T)tmp; |
| 31065 | |
| 31066 | /* End of DataTypeConversion: '<S570>/Data Type Conversion2' */ |
| 31067 | |
| 31068 | /* DataTypeConversion: '<S258>/Data Type Conversion3' */ |
| 31069 | tmp = (real32_T)floor(fusionAlg_B.Selector32.OBJ_Class_Probability); |
| 31070 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31071 | tmp = 0.0F; |
| 31072 | } else { |
| 31073 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31074 | } |
| 31075 | |
| 31076 | fusionAlg_B.Obj_TypeConf_i1 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31077 | (uint32_T)tmp; |
| 31078 | |
| 31079 | /* End of DataTypeConversion: '<S258>/Data Type Conversion3' */ |
| 31080 | |
| 31081 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' */ |
| 31082 | fusionAlg_B.ObjList.vision_33_obj.obj_coordinate.lateral = |
| 31083 | fusionAlg_B.Selector32.OBJ_Lat_Distance; |
| 31084 | fusionAlg_B.ObjList.vision_33_obj.obj_coordinate.lateralVariance = |
| 31085 | fusionAlg_B.Selector32.OBJ_Lat_Distance_STD; |
| 31086 | fusionAlg_B.ObjList.vision_33_obj.obj_coordinate.longitudinal = |
| 31087 | fusionAlg_B.Selector32.OBJ_Long_Distance; |
| 31088 | fusionAlg_B.ObjList.vision_33_obj.obj_coordinate.longitudinalVariance = |
| 31089 | fusionAlg_B.Selector32.OBJ_Long_Distance_STD; |
| 31090 | |
| 31091 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' */ |
| 31092 | fusionAlg_B.ObjList.vision_33_obj.obj_velocity.Vx = |
| 31093 | fusionAlg_B.Selector32.OBJ_Abs_Long_Velocity; |
| 31094 | fusionAlg_B.ObjList.vision_33_obj.obj_velocity.VxVariance = |
| 31095 | fusionAlg_B.Selector32.OBJ_Abs_Long_Velocity_STD; |
| 31096 | fusionAlg_B.ObjList.vision_33_obj.obj_velocity.Vy = |
| 31097 | fusionAlg_B.Selector32.OBJ_Abs_Lat_Velocity; |
| 31098 | fusionAlg_B.ObjList.vision_33_obj.obj_velocity.VyVariance = |
| 31099 | fusionAlg_B.Selector32.OBJ_Abs_Lat_Velocity_STD; |
| 31100 | |
| 31101 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' */ |
| 31102 | fusionAlg_B.ObjList.vision_33_obj.obj_angleOfCenter.centerAngle = |
| 31103 | fusionAlg_B.Selector32.OBJ_Angle_Mid; |
| 31104 | fusionAlg_B.ObjList.vision_33_obj.obj_angleOfCenter.centerAngleVariance = |
| 31105 | fusionAlg_B.Selector32.OBJ_Angle_Mid_STD; |
| 31106 | |
| 31107 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' */ |
| 31108 | fusionAlg_B.ObjList.vision_33_obj.obj_acceleration.Ax = |
| 31109 | fusionAlg_B.Selector32.OBJ_Abs_Long_Acc; |
| 31110 | fusionAlg_B.ObjList.vision_33_obj.obj_acceleration.AxVariance = |
| 31111 | fusionAlg_B.Selector32.OBJ_Abs_Long_Acc_STD; |
| 31112 | fusionAlg_B.ObjList.vision_33_obj.obj_acceleration.Ay = |
| 31113 | fusionAlg_B.Selector32.OBJ_Abs_Lat_Acc; |
| 31114 | fusionAlg_B.ObjList.vision_33_obj.obj_acceleration.AyVariance = |
| 31115 | fusionAlg_B.Selector32.OBJ_Abs_Lat_Acc_STD; |
| 31116 | |
| 31117 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' */ |
| 31118 | fusionAlg_B.ObjList.vision_33_obj.AyVariance.length = |
| 31119 | fusionAlg_B.Selector32.OBJ_Length; |
| 31120 | fusionAlg_B.ObjList.vision_33_obj.AyVariance.width = |
| 31121 | fusionAlg_B.Selector32.OBJ_Width; |
| 31122 | fusionAlg_B.ObjList.vision_33_obj.AyVariance.height = |
| 31123 | fusionAlg_B.Selector32.OBJ_Height; |
| 31124 | |
| 31125 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' incorporates: |
| 31126 | * Constant: '<S567>/Constant1' |
| 31127 | * Constant: '<S567>/Constant2' |
| 31128 | * Constant: '<S567>/Constant3' |
| 31129 | */ |
| 31130 | fusionAlg_B.ObjList.vision_33_obj.reserved1.reserved0 = |
| 31131 | fusionAlg_P_g.Constant2_Value_fe; |
| 31132 | fusionAlg_B.ObjList.vision_33_obj.reserved1.reserved1 = |
| 31133 | fusionAlg_P_g.Constant1_Value_g1; |
| 31134 | fusionAlg_B.ObjList.vision_33_obj.reserved1.reserved2 = |
| 31135 | fusionAlg_P_g.Constant3_Value_gl; |
| 31136 | |
| 31137 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' incorporates: |
| 31138 | * Constant: '<S568>/Constant5' |
| 31139 | * Constant: '<S568>/Constant6' |
| 31140 | */ |
| 31141 | fusionAlg_B.ObjList.vision_33_obj.reserved2.reserved0 = |
| 31142 | fusionAlg_P_g.Constant5_Value_lzo; |
| 31143 | fusionAlg_B.ObjList.vision_33_obj.reserved2.reserved1 = |
| 31144 | fusionAlg_P_g.Constant6_Value_eg; |
| 31145 | |
| 31146 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_32' incorporates: |
| 31147 | * Constant: '<S258>/Constant' |
| 31148 | * Constant: '<S258>/Constant1' |
| 31149 | * Constant: '<S258>/Constant2' |
| 31150 | * Constant: '<S258>/Constant3' |
| 31151 | * Constant: '<S258>/Constant4' |
| 31152 | */ |
| 31153 | fusionAlg_B.ObjList.vision_33_obj.obj_type = fusionAlg_B.Obj_Type_il; |
| 31154 | fusionAlg_B.ObjList.vision_33_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_i1; |
| 31155 | fusionAlg_B.ObjList.vision_33_obj.obj_TTC = fusionAlg_B.Selector32.OBJ_Inv_TTC; |
| 31156 | fusionAlg_B.ObjList.vision_33_obj.obj_TTCVariance = |
| 31157 | fusionAlg_B.Selector32.OBJ_Inv_TTC_STD; |
| 31158 | fusionAlg_B.ObjList.vision_33_obj.obj_existProb = |
| 31159 | fusionAlg_P_g.Constant_Value_aq; |
| 31160 | fusionAlg_B.ObjList.vision_33_obj.obj_angleOfObject = |
| 31161 | fusionAlg_P_g.Constant1_Value_grx; |
| 31162 | fusionAlg_B.ObjList.vision_33_obj.obj_Heading = |
| 31163 | fusionAlg_B.Selector32.OBJ_Heading; |
| 31164 | fusionAlg_B.ObjList.vision_33_obj.obj_Heading_STD = |
| 31165 | fusionAlg_P_g.Constant2_Value_gu; |
| 31166 | fusionAlg_B.ObjList.vision_33_obj.obj_Heading_V = |
| 31167 | fusionAlg_P_g.Constant3_Value_lr; |
| 31168 | fusionAlg_B.ObjList.vision_33_obj.obj_Heading_STD_V = |
| 31169 | fusionAlg_P_g.Constant4_Value_kg; |
| 31170 | |
| 31171 | /* Selector: '<S223>/Selector33' incorporates: |
| 31172 | * Constant: '<S223>/Constant33' |
| 31173 | */ |
| 31174 | fusionAlg_B.Selector33 = rtu_EyeQ4_Info_st-> |
| 31175 | OBJ_BUS[fusionAlg_P_g.Constant33_Value_g]; |
| 31176 | |
| 31177 | /* DataTypeConversion: '<S259>/Data Type Conversion' */ |
| 31178 | tmp = (real32_T)floor(fusionAlg_B.Selector33.OBJ_ID); |
| 31179 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31180 | tmp = 0.0F; |
| 31181 | } else { |
| 31182 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31183 | } |
| 31184 | |
| 31185 | fusionAlg_B.ObjList.vision_34_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 31186 | (uint32_T)-tmp : (uint32_T)tmp; |
| 31187 | |
| 31188 | /* End of DataTypeConversion: '<S259>/Data Type Conversion' */ |
| 31189 | |
| 31190 | /* Lookup_n-D: '<S580>/1-D Lookup Table' */ |
| 31191 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector33.OBJ_Measuring_Status, |
| 31192 | fusionAlg_P_g.uDLookupTable_bp01Data_an, 7U); |
| 31193 | fusionAlg_B.Obj_Status_hi = fusionAlg_P_g.uDLookupTable_tableData_ip[bpIdx]; |
| 31194 | |
| 31195 | /* DataTypeConversion: '<S580>/Data Type Conversion1' */ |
| 31196 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_hi); |
| 31197 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31198 | tmp = 0.0F; |
| 31199 | } else { |
| 31200 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31201 | } |
| 31202 | |
| 31203 | fusionAlg_B.ObjList.vision_34_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 31204 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 31205 | |
| 31206 | /* End of DataTypeConversion: '<S580>/Data Type Conversion1' */ |
| 31207 | |
| 31208 | /* DataTypeConversion: '<S571>/Data Type Conversion' */ |
| 31209 | tmp = (real32_T)floor(fusionAlg_B.Selector33.OBJ_Object_Age); |
| 31210 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31211 | tmp = 0.0F; |
| 31212 | } else { |
| 31213 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 31214 | } |
| 31215 | |
| 31216 | fusionAlg_B.measureAge_mq = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 31217 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 31218 | |
| 31219 | /* End of DataTypeConversion: '<S571>/Data Type Conversion' */ |
| 31220 | |
| 31221 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' incorporates: |
| 31222 | * Constant: '<S571>/Constant' |
| 31223 | * Constant: '<S571>/Constant1' |
| 31224 | */ |
| 31225 | fusionAlg_B.ObjList.vision_34_obj.obj_stageAge.totalAge = |
| 31226 | fusionAlg_B.measureAge_mq; |
| 31227 | fusionAlg_B.ObjList.vision_34_obj.obj_stageAge.initAge = |
| 31228 | fusionAlg_P_g.Constant_Value_mg; |
| 31229 | fusionAlg_B.ObjList.vision_34_obj.obj_stageAge.measureAge = |
| 31230 | fusionAlg_B.measureAge_mq; |
| 31231 | fusionAlg_B.ObjList.vision_34_obj.obj_stageAge.predictAge = |
| 31232 | fusionAlg_P_g.Constant1_Value_oq; |
| 31233 | |
| 31234 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' incorporates: |
| 31235 | * Constant: '<S572>/Constant' |
| 31236 | * Constant: '<S572>/Constant1' |
| 31237 | * Constant: '<S572>/Constant2' |
| 31238 | * Constant: '<S572>/Constant3' |
| 31239 | */ |
| 31240 | fusionAlg_B.ObjList.vision_34_obj.obj_boundary.X1 = |
| 31241 | fusionAlg_P_g.Constant_Value_dz; |
| 31242 | fusionAlg_B.ObjList.vision_34_obj.obj_boundary.Y1 = |
| 31243 | fusionAlg_P_g.Constant1_Value_f3; |
| 31244 | fusionAlg_B.ObjList.vision_34_obj.obj_boundary.X2 = |
| 31245 | fusionAlg_P_g.Constant2_Value_mm4; |
| 31246 | fusionAlg_B.ObjList.vision_34_obj.obj_boundary.Y2 = |
| 31247 | fusionAlg_P_g.Constant3_Value_ix; |
| 31248 | |
| 31249 | /* Lookup_n-D: '<S581>/1-D Lookup Table' */ |
| 31250 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector33.OBJ_Object_Class, |
| 31251 | fusionAlg_P_g.uDLookupTable_bp01Data_ee, 8U); |
| 31252 | fusionAlg_B.Obj_Status_pb0 = fusionAlg_P_g.uDLookupTable_tableData_ix[bpIdx]; |
| 31253 | |
| 31254 | /* DataTypeConversion: '<S581>/Data Type Conversion2' */ |
| 31255 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_pb0); |
| 31256 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31257 | tmp = 0.0F; |
| 31258 | } else { |
| 31259 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31260 | } |
| 31261 | |
| 31262 | fusionAlg_B.Obj_Type_br = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31263 | (uint32_T)tmp; |
| 31264 | |
| 31265 | /* End of DataTypeConversion: '<S581>/Data Type Conversion2' */ |
| 31266 | |
| 31267 | /* DataTypeConversion: '<S259>/Data Type Conversion3' */ |
| 31268 | tmp = (real32_T)floor(fusionAlg_B.Selector33.OBJ_Class_Probability); |
| 31269 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31270 | tmp = 0.0F; |
| 31271 | } else { |
| 31272 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31273 | } |
| 31274 | |
| 31275 | fusionAlg_B.Obj_TypeConf_if = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31276 | (uint32_T)tmp; |
| 31277 | |
| 31278 | /* End of DataTypeConversion: '<S259>/Data Type Conversion3' */ |
| 31279 | |
| 31280 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' */ |
| 31281 | fusionAlg_B.ObjList.vision_34_obj.obj_coordinate.lateral = |
| 31282 | fusionAlg_B.Selector33.OBJ_Lat_Distance; |
| 31283 | fusionAlg_B.ObjList.vision_34_obj.obj_coordinate.lateralVariance = |
| 31284 | fusionAlg_B.Selector33.OBJ_Lat_Distance_STD; |
| 31285 | fusionAlg_B.ObjList.vision_34_obj.obj_coordinate.longitudinal = |
| 31286 | fusionAlg_B.Selector33.OBJ_Long_Distance; |
| 31287 | fusionAlg_B.ObjList.vision_34_obj.obj_coordinate.longitudinalVariance = |
| 31288 | fusionAlg_B.Selector33.OBJ_Long_Distance_STD; |
| 31289 | |
| 31290 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' */ |
| 31291 | fusionAlg_B.ObjList.vision_34_obj.obj_velocity.Vx = |
| 31292 | fusionAlg_B.Selector33.OBJ_Abs_Long_Velocity; |
| 31293 | fusionAlg_B.ObjList.vision_34_obj.obj_velocity.VxVariance = |
| 31294 | fusionAlg_B.Selector33.OBJ_Abs_Long_Velocity_STD; |
| 31295 | fusionAlg_B.ObjList.vision_34_obj.obj_velocity.Vy = |
| 31296 | fusionAlg_B.Selector33.OBJ_Abs_Lat_Velocity; |
| 31297 | fusionAlg_B.ObjList.vision_34_obj.obj_velocity.VyVariance = |
| 31298 | fusionAlg_B.Selector33.OBJ_Abs_Lat_Velocity_STD; |
| 31299 | |
| 31300 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' */ |
| 31301 | fusionAlg_B.ObjList.vision_34_obj.obj_angleOfCenter.centerAngle = |
| 31302 | fusionAlg_B.Selector33.OBJ_Angle_Mid; |
| 31303 | fusionAlg_B.ObjList.vision_34_obj.obj_angleOfCenter.centerAngleVariance = |
| 31304 | fusionAlg_B.Selector33.OBJ_Angle_Mid_STD; |
| 31305 | |
| 31306 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' */ |
| 31307 | fusionAlg_B.ObjList.vision_34_obj.obj_acceleration.Ax = |
| 31308 | fusionAlg_B.Selector33.OBJ_Abs_Long_Acc; |
| 31309 | fusionAlg_B.ObjList.vision_34_obj.obj_acceleration.AxVariance = |
| 31310 | fusionAlg_B.Selector33.OBJ_Abs_Long_Acc_STD; |
| 31311 | fusionAlg_B.ObjList.vision_34_obj.obj_acceleration.Ay = |
| 31312 | fusionAlg_B.Selector33.OBJ_Abs_Lat_Acc; |
| 31313 | fusionAlg_B.ObjList.vision_34_obj.obj_acceleration.AyVariance = |
| 31314 | fusionAlg_B.Selector33.OBJ_Abs_Lat_Acc_STD; |
| 31315 | |
| 31316 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' */ |
| 31317 | fusionAlg_B.ObjList.vision_34_obj.AyVariance.length = |
| 31318 | fusionAlg_B.Selector33.OBJ_Length; |
| 31319 | fusionAlg_B.ObjList.vision_34_obj.AyVariance.width = |
| 31320 | fusionAlg_B.Selector33.OBJ_Width; |
| 31321 | fusionAlg_B.ObjList.vision_34_obj.AyVariance.height = |
| 31322 | fusionAlg_B.Selector33.OBJ_Height; |
| 31323 | |
| 31324 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' incorporates: |
| 31325 | * Constant: '<S578>/Constant1' |
| 31326 | * Constant: '<S578>/Constant2' |
| 31327 | * Constant: '<S578>/Constant3' |
| 31328 | */ |
| 31329 | fusionAlg_B.ObjList.vision_34_obj.reserved1.reserved0 = |
| 31330 | fusionAlg_P_g.Constant2_Value_jfv; |
| 31331 | fusionAlg_B.ObjList.vision_34_obj.reserved1.reserved1 = |
| 31332 | fusionAlg_P_g.Constant1_Value_eg; |
| 31333 | fusionAlg_B.ObjList.vision_34_obj.reserved1.reserved2 = |
| 31334 | fusionAlg_P_g.Constant3_Value_cj0; |
| 31335 | |
| 31336 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' incorporates: |
| 31337 | * Constant: '<S579>/Constant5' |
| 31338 | * Constant: '<S579>/Constant6' |
| 31339 | */ |
| 31340 | fusionAlg_B.ObjList.vision_34_obj.reserved2.reserved0 = |
| 31341 | fusionAlg_P_g.Constant5_Value_ovc; |
| 31342 | fusionAlg_B.ObjList.vision_34_obj.reserved2.reserved1 = |
| 31343 | fusionAlg_P_g.Constant6_Value_os; |
| 31344 | |
| 31345 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_33' incorporates: |
| 31346 | * Constant: '<S259>/Constant' |
| 31347 | * Constant: '<S259>/Constant1' |
| 31348 | * Constant: '<S259>/Constant2' |
| 31349 | * Constant: '<S259>/Constant3' |
| 31350 | * Constant: '<S259>/Constant4' |
| 31351 | */ |
| 31352 | fusionAlg_B.ObjList.vision_34_obj.obj_type = fusionAlg_B.Obj_Type_br; |
| 31353 | fusionAlg_B.ObjList.vision_34_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_if; |
| 31354 | fusionAlg_B.ObjList.vision_34_obj.obj_TTC = fusionAlg_B.Selector33.OBJ_Inv_TTC; |
| 31355 | fusionAlg_B.ObjList.vision_34_obj.obj_TTCVariance = |
| 31356 | fusionAlg_B.Selector33.OBJ_Inv_TTC_STD; |
| 31357 | fusionAlg_B.ObjList.vision_34_obj.obj_existProb = |
| 31358 | fusionAlg_P_g.Constant_Value_e2; |
| 31359 | fusionAlg_B.ObjList.vision_34_obj.obj_angleOfObject = |
| 31360 | fusionAlg_P_g.Constant1_Value_g2r; |
| 31361 | fusionAlg_B.ObjList.vision_34_obj.obj_Heading = |
| 31362 | fusionAlg_B.Selector33.OBJ_Heading; |
| 31363 | fusionAlg_B.ObjList.vision_34_obj.obj_Heading_STD = |
| 31364 | fusionAlg_P_g.Constant2_Value_pq; |
| 31365 | fusionAlg_B.ObjList.vision_34_obj.obj_Heading_V = |
| 31366 | fusionAlg_P_g.Constant3_Value_pe; |
| 31367 | fusionAlg_B.ObjList.vision_34_obj.obj_Heading_STD_V = |
| 31368 | fusionAlg_P_g.Constant4_Value_kve; |
| 31369 | |
| 31370 | /* Selector: '<S223>/Selector34' incorporates: |
| 31371 | * Constant: '<S223>/Constant34' |
| 31372 | */ |
| 31373 | fusionAlg_B.Selector34 = rtu_EyeQ4_Info_st-> |
| 31374 | OBJ_BUS[fusionAlg_P_g.Constant34_Value_j]; |
| 31375 | |
| 31376 | /* DataTypeConversion: '<S260>/Data Type Conversion' */ |
| 31377 | tmp = (real32_T)floor(fusionAlg_B.Selector34.OBJ_ID); |
| 31378 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31379 | tmp = 0.0F; |
| 31380 | } else { |
| 31381 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31382 | } |
| 31383 | |
| 31384 | fusionAlg_B.ObjList.vision_35_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 31385 | (uint32_T)-tmp : (uint32_T)tmp; |
| 31386 | |
| 31387 | /* End of DataTypeConversion: '<S260>/Data Type Conversion' */ |
| 31388 | |
| 31389 | /* Lookup_n-D: '<S591>/1-D Lookup Table' */ |
| 31390 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector34.OBJ_Measuring_Status, |
| 31391 | fusionAlg_P_g.uDLookupTable_bp01Data_fiw, 7U); |
| 31392 | fusionAlg_B.Obj_Status_dc = fusionAlg_P_g.uDLookupTable_tableData_gs[bpIdx]; |
| 31393 | |
| 31394 | /* DataTypeConversion: '<S591>/Data Type Conversion1' */ |
| 31395 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_dc); |
| 31396 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31397 | tmp = 0.0F; |
| 31398 | } else { |
| 31399 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31400 | } |
| 31401 | |
| 31402 | fusionAlg_B.ObjList.vision_35_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 31403 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 31404 | |
| 31405 | /* End of DataTypeConversion: '<S591>/Data Type Conversion1' */ |
| 31406 | |
| 31407 | /* DataTypeConversion: '<S582>/Data Type Conversion' */ |
| 31408 | tmp = (real32_T)floor(fusionAlg_B.Selector34.OBJ_Object_Age); |
| 31409 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31410 | tmp = 0.0F; |
| 31411 | } else { |
| 31412 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 31413 | } |
| 31414 | |
| 31415 | fusionAlg_B.measureAge_bg = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 31416 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 31417 | |
| 31418 | /* End of DataTypeConversion: '<S582>/Data Type Conversion' */ |
| 31419 | |
| 31420 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' incorporates: |
| 31421 | * Constant: '<S582>/Constant' |
| 31422 | * Constant: '<S582>/Constant1' |
| 31423 | */ |
| 31424 | fusionAlg_B.ObjList.vision_35_obj.obj_stageAge.totalAge = |
| 31425 | fusionAlg_B.measureAge_bg; |
| 31426 | fusionAlg_B.ObjList.vision_35_obj.obj_stageAge.initAge = |
| 31427 | fusionAlg_P_g.Constant_Value_dq; |
| 31428 | fusionAlg_B.ObjList.vision_35_obj.obj_stageAge.measureAge = |
| 31429 | fusionAlg_B.measureAge_bg; |
| 31430 | fusionAlg_B.ObjList.vision_35_obj.obj_stageAge.predictAge = |
| 31431 | fusionAlg_P_g.Constant1_Value_ex; |
| 31432 | |
| 31433 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' incorporates: |
| 31434 | * Constant: '<S583>/Constant' |
| 31435 | * Constant: '<S583>/Constant1' |
| 31436 | * Constant: '<S583>/Constant2' |
| 31437 | * Constant: '<S583>/Constant3' |
| 31438 | */ |
| 31439 | fusionAlg_B.ObjList.vision_35_obj.obj_boundary.X1 = |
| 31440 | fusionAlg_P_g.Constant_Value_mr; |
| 31441 | fusionAlg_B.ObjList.vision_35_obj.obj_boundary.Y1 = |
| 31442 | fusionAlg_P_g.Constant1_Value_p2; |
| 31443 | fusionAlg_B.ObjList.vision_35_obj.obj_boundary.X2 = |
| 31444 | fusionAlg_P_g.Constant2_Value_hed; |
| 31445 | fusionAlg_B.ObjList.vision_35_obj.obj_boundary.Y2 = |
| 31446 | fusionAlg_P_g.Constant3_Value_kqp; |
| 31447 | |
| 31448 | /* Lookup_n-D: '<S592>/1-D Lookup Table' */ |
| 31449 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector34.OBJ_Object_Class, |
| 31450 | fusionAlg_P_g.uDLookupTable_bp01Data_ca, 8U); |
| 31451 | fusionAlg_B.Obj_Status_gp = fusionAlg_P_g.uDLookupTable_tableData_lr[bpIdx]; |
| 31452 | |
| 31453 | /* DataTypeConversion: '<S592>/Data Type Conversion2' */ |
| 31454 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_gp); |
| 31455 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31456 | tmp = 0.0F; |
| 31457 | } else { |
| 31458 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31459 | } |
| 31460 | |
| 31461 | fusionAlg_B.Obj_Type_gf = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31462 | (uint32_T)tmp; |
| 31463 | |
| 31464 | /* End of DataTypeConversion: '<S592>/Data Type Conversion2' */ |
| 31465 | |
| 31466 | /* DataTypeConversion: '<S260>/Data Type Conversion3' */ |
| 31467 | tmp = (real32_T)floor(fusionAlg_B.Selector34.OBJ_Class_Probability); |
| 31468 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31469 | tmp = 0.0F; |
| 31470 | } else { |
| 31471 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31472 | } |
| 31473 | |
| 31474 | fusionAlg_B.Obj_TypeConf_c5 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31475 | (uint32_T)tmp; |
| 31476 | |
| 31477 | /* End of DataTypeConversion: '<S260>/Data Type Conversion3' */ |
| 31478 | |
| 31479 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' */ |
| 31480 | fusionAlg_B.ObjList.vision_35_obj.obj_coordinate.lateral = |
| 31481 | fusionAlg_B.Selector34.OBJ_Lat_Distance; |
| 31482 | fusionAlg_B.ObjList.vision_35_obj.obj_coordinate.lateralVariance = |
| 31483 | fusionAlg_B.Selector34.OBJ_Lat_Distance_STD; |
| 31484 | fusionAlg_B.ObjList.vision_35_obj.obj_coordinate.longitudinal = |
| 31485 | fusionAlg_B.Selector34.OBJ_Long_Distance; |
| 31486 | fusionAlg_B.ObjList.vision_35_obj.obj_coordinate.longitudinalVariance = |
| 31487 | fusionAlg_B.Selector34.OBJ_Long_Distance_STD; |
| 31488 | |
| 31489 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' */ |
| 31490 | fusionAlg_B.ObjList.vision_35_obj.obj_velocity.Vx = |
| 31491 | fusionAlg_B.Selector34.OBJ_Abs_Long_Velocity; |
| 31492 | fusionAlg_B.ObjList.vision_35_obj.obj_velocity.VxVariance = |
| 31493 | fusionAlg_B.Selector34.OBJ_Abs_Long_Velocity_STD; |
| 31494 | fusionAlg_B.ObjList.vision_35_obj.obj_velocity.Vy = |
| 31495 | fusionAlg_B.Selector34.OBJ_Abs_Lat_Velocity; |
| 31496 | fusionAlg_B.ObjList.vision_35_obj.obj_velocity.VyVariance = |
| 31497 | fusionAlg_B.Selector34.OBJ_Abs_Lat_Velocity_STD; |
| 31498 | |
| 31499 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' */ |
| 31500 | fusionAlg_B.ObjList.vision_35_obj.obj_angleOfCenter.centerAngle = |
| 31501 | fusionAlg_B.Selector34.OBJ_Angle_Mid; |
| 31502 | fusionAlg_B.ObjList.vision_35_obj.obj_angleOfCenter.centerAngleVariance = |
| 31503 | fusionAlg_B.Selector34.OBJ_Angle_Mid_STD; |
| 31504 | |
| 31505 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' */ |
| 31506 | fusionAlg_B.ObjList.vision_35_obj.obj_acceleration.Ax = |
| 31507 | fusionAlg_B.Selector34.OBJ_Abs_Long_Acc; |
| 31508 | fusionAlg_B.ObjList.vision_35_obj.obj_acceleration.AxVariance = |
| 31509 | fusionAlg_B.Selector34.OBJ_Abs_Long_Acc_STD; |
| 31510 | fusionAlg_B.ObjList.vision_35_obj.obj_acceleration.Ay = |
| 31511 | fusionAlg_B.Selector34.OBJ_Abs_Lat_Acc; |
| 31512 | fusionAlg_B.ObjList.vision_35_obj.obj_acceleration.AyVariance = |
| 31513 | fusionAlg_B.Selector34.OBJ_Abs_Lat_Acc_STD; |
| 31514 | |
| 31515 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' */ |
| 31516 | fusionAlg_B.ObjList.vision_35_obj.AyVariance.length = |
| 31517 | fusionAlg_B.Selector34.OBJ_Length; |
| 31518 | fusionAlg_B.ObjList.vision_35_obj.AyVariance.width = |
| 31519 | fusionAlg_B.Selector34.OBJ_Width; |
| 31520 | fusionAlg_B.ObjList.vision_35_obj.AyVariance.height = |
| 31521 | fusionAlg_B.Selector34.OBJ_Height; |
| 31522 | |
| 31523 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' incorporates: |
| 31524 | * Constant: '<S589>/Constant1' |
| 31525 | * Constant: '<S589>/Constant2' |
| 31526 | * Constant: '<S589>/Constant3' |
| 31527 | */ |
| 31528 | fusionAlg_B.ObjList.vision_35_obj.reserved1.reserved0 = |
| 31529 | fusionAlg_P_g.Constant2_Value_oa; |
| 31530 | fusionAlg_B.ObjList.vision_35_obj.reserved1.reserved1 = |
| 31531 | fusionAlg_P_g.Constant1_Value_gp4; |
| 31532 | fusionAlg_B.ObjList.vision_35_obj.reserved1.reserved2 = |
| 31533 | fusionAlg_P_g.Constant3_Value_pqs; |
| 31534 | |
| 31535 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' incorporates: |
| 31536 | * Constant: '<S590>/Constant5' |
| 31537 | * Constant: '<S590>/Constant6' |
| 31538 | */ |
| 31539 | fusionAlg_B.ObjList.vision_35_obj.reserved2.reserved0 = |
| 31540 | fusionAlg_P_g.Constant5_Value_iei; |
| 31541 | fusionAlg_B.ObjList.vision_35_obj.reserved2.reserved1 = |
| 31542 | fusionAlg_P_g.Constant6_Value_ggg; |
| 31543 | |
| 31544 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_34' incorporates: |
| 31545 | * Constant: '<S260>/Constant' |
| 31546 | * Constant: '<S260>/Constant1' |
| 31547 | * Constant: '<S260>/Constant2' |
| 31548 | * Constant: '<S260>/Constant3' |
| 31549 | * Constant: '<S260>/Constant4' |
| 31550 | */ |
| 31551 | fusionAlg_B.ObjList.vision_35_obj.obj_type = fusionAlg_B.Obj_Type_gf; |
| 31552 | fusionAlg_B.ObjList.vision_35_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_c5; |
| 31553 | fusionAlg_B.ObjList.vision_35_obj.obj_TTC = fusionAlg_B.Selector34.OBJ_Inv_TTC; |
| 31554 | fusionAlg_B.ObjList.vision_35_obj.obj_TTCVariance = |
| 31555 | fusionAlg_B.Selector34.OBJ_Inv_TTC_STD; |
| 31556 | fusionAlg_B.ObjList.vision_35_obj.obj_existProb = |
| 31557 | fusionAlg_P_g.Constant_Value_gc; |
| 31558 | fusionAlg_B.ObjList.vision_35_obj.obj_angleOfObject = |
| 31559 | fusionAlg_P_g.Constant1_Value_br; |
| 31560 | fusionAlg_B.ObjList.vision_35_obj.obj_Heading = |
| 31561 | fusionAlg_B.Selector34.OBJ_Heading; |
| 31562 | fusionAlg_B.ObjList.vision_35_obj.obj_Heading_STD = |
| 31563 | fusionAlg_P_g.Constant2_Value_hr; |
| 31564 | fusionAlg_B.ObjList.vision_35_obj.obj_Heading_V = |
| 31565 | fusionAlg_P_g.Constant3_Value_gg; |
| 31566 | fusionAlg_B.ObjList.vision_35_obj.obj_Heading_STD_V = |
| 31567 | fusionAlg_P_g.Constant4_Value_f2; |
| 31568 | |
| 31569 | /* Selector: '<S223>/Selector35' incorporates: |
| 31570 | * Constant: '<S223>/Constant35' |
| 31571 | */ |
| 31572 | fusionAlg_B.Selector35 = rtu_EyeQ4_Info_st-> |
| 31573 | OBJ_BUS[fusionAlg_P_g.Constant35_Value_e]; |
| 31574 | |
| 31575 | /* DataTypeConversion: '<S261>/Data Type Conversion' */ |
| 31576 | tmp = (real32_T)floor(fusionAlg_B.Selector35.OBJ_ID); |
| 31577 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31578 | tmp = 0.0F; |
| 31579 | } else { |
| 31580 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31581 | } |
| 31582 | |
| 31583 | fusionAlg_B.ObjList.vision_36_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 31584 | (uint32_T)-tmp : (uint32_T)tmp; |
| 31585 | |
| 31586 | /* End of DataTypeConversion: '<S261>/Data Type Conversion' */ |
| 31587 | |
| 31588 | /* Lookup_n-D: '<S602>/1-D Lookup Table' */ |
| 31589 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector35.OBJ_Measuring_Status, |
| 31590 | fusionAlg_P_g.uDLookupTable_bp01Data_or, 7U); |
| 31591 | fusionAlg_B.Obj_Status_cq = fusionAlg_P_g.uDLookupTable_tableData_i1[bpIdx]; |
| 31592 | |
| 31593 | /* DataTypeConversion: '<S602>/Data Type Conversion1' */ |
| 31594 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_cq); |
| 31595 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31596 | tmp = 0.0F; |
| 31597 | } else { |
| 31598 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31599 | } |
| 31600 | |
| 31601 | fusionAlg_B.ObjList.vision_36_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 31602 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 31603 | |
| 31604 | /* End of DataTypeConversion: '<S602>/Data Type Conversion1' */ |
| 31605 | |
| 31606 | /* DataTypeConversion: '<S593>/Data Type Conversion' */ |
| 31607 | tmp = (real32_T)floor(fusionAlg_B.Selector35.OBJ_Object_Age); |
| 31608 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31609 | tmp = 0.0F; |
| 31610 | } else { |
| 31611 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 31612 | } |
| 31613 | |
| 31614 | fusionAlg_B.measureAge_ki = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 31615 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 31616 | |
| 31617 | /* End of DataTypeConversion: '<S593>/Data Type Conversion' */ |
| 31618 | |
| 31619 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' incorporates: |
| 31620 | * Constant: '<S593>/Constant' |
| 31621 | * Constant: '<S593>/Constant1' |
| 31622 | */ |
| 31623 | fusionAlg_B.ObjList.vision_36_obj.obj_stageAge.totalAge = |
| 31624 | fusionAlg_B.measureAge_ki; |
| 31625 | fusionAlg_B.ObjList.vision_36_obj.obj_stageAge.initAge = |
| 31626 | fusionAlg_P_g.Constant_Value_en; |
| 31627 | fusionAlg_B.ObjList.vision_36_obj.obj_stageAge.measureAge = |
| 31628 | fusionAlg_B.measureAge_ki; |
| 31629 | fusionAlg_B.ObjList.vision_36_obj.obj_stageAge.predictAge = |
| 31630 | fusionAlg_P_g.Constant1_Value_f4; |
| 31631 | |
| 31632 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' incorporates: |
| 31633 | * Constant: '<S594>/Constant' |
| 31634 | * Constant: '<S594>/Constant1' |
| 31635 | * Constant: '<S594>/Constant2' |
| 31636 | * Constant: '<S594>/Constant3' |
| 31637 | */ |
| 31638 | fusionAlg_B.ObjList.vision_36_obj.obj_boundary.X1 = |
| 31639 | fusionAlg_P_g.Constant_Value_n0; |
| 31640 | fusionAlg_B.ObjList.vision_36_obj.obj_boundary.Y1 = |
| 31641 | fusionAlg_P_g.Constant1_Value_ar; |
| 31642 | fusionAlg_B.ObjList.vision_36_obj.obj_boundary.X2 = |
| 31643 | fusionAlg_P_g.Constant2_Value_jn; |
| 31644 | fusionAlg_B.ObjList.vision_36_obj.obj_boundary.Y2 = |
| 31645 | fusionAlg_P_g.Constant3_Value_hg; |
| 31646 | |
| 31647 | /* Lookup_n-D: '<S603>/1-D Lookup Table' */ |
| 31648 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector35.OBJ_Object_Class, |
| 31649 | fusionAlg_P_g.uDLookupTable_bp01Data_jn, 8U); |
| 31650 | fusionAlg_B.Obj_Status_hm = fusionAlg_P_g.uDLookupTable_tableData_ik[bpIdx]; |
| 31651 | |
| 31652 | /* DataTypeConversion: '<S603>/Data Type Conversion2' */ |
| 31653 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_hm); |
| 31654 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31655 | tmp = 0.0F; |
| 31656 | } else { |
| 31657 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31658 | } |
| 31659 | |
| 31660 | fusionAlg_B.Obj_Type_fy = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31661 | (uint32_T)tmp; |
| 31662 | |
| 31663 | /* End of DataTypeConversion: '<S603>/Data Type Conversion2' */ |
| 31664 | |
| 31665 | /* DataTypeConversion: '<S261>/Data Type Conversion3' */ |
| 31666 | tmp = (real32_T)floor(fusionAlg_B.Selector35.OBJ_Class_Probability); |
| 31667 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31668 | tmp = 0.0F; |
| 31669 | } else { |
| 31670 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31671 | } |
| 31672 | |
| 31673 | fusionAlg_B.Obj_TypeConf_e1 = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31674 | (uint32_T)tmp; |
| 31675 | |
| 31676 | /* End of DataTypeConversion: '<S261>/Data Type Conversion3' */ |
| 31677 | |
| 31678 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' */ |
| 31679 | fusionAlg_B.ObjList.vision_36_obj.obj_coordinate.lateral = |
| 31680 | fusionAlg_B.Selector35.OBJ_Lat_Distance; |
| 31681 | fusionAlg_B.ObjList.vision_36_obj.obj_coordinate.lateralVariance = |
| 31682 | fusionAlg_B.Selector35.OBJ_Lat_Distance_STD; |
| 31683 | fusionAlg_B.ObjList.vision_36_obj.obj_coordinate.longitudinal = |
| 31684 | fusionAlg_B.Selector35.OBJ_Long_Distance; |
| 31685 | fusionAlg_B.ObjList.vision_36_obj.obj_coordinate.longitudinalVariance = |
| 31686 | fusionAlg_B.Selector35.OBJ_Long_Distance_STD; |
| 31687 | |
| 31688 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' */ |
| 31689 | fusionAlg_B.ObjList.vision_36_obj.obj_velocity.Vx = |
| 31690 | fusionAlg_B.Selector35.OBJ_Abs_Long_Velocity; |
| 31691 | fusionAlg_B.ObjList.vision_36_obj.obj_velocity.VxVariance = |
| 31692 | fusionAlg_B.Selector35.OBJ_Abs_Long_Velocity_STD; |
| 31693 | fusionAlg_B.ObjList.vision_36_obj.obj_velocity.Vy = |
| 31694 | fusionAlg_B.Selector35.OBJ_Abs_Lat_Velocity; |
| 31695 | fusionAlg_B.ObjList.vision_36_obj.obj_velocity.VyVariance = |
| 31696 | fusionAlg_B.Selector35.OBJ_Abs_Lat_Velocity_STD; |
| 31697 | |
| 31698 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' */ |
| 31699 | fusionAlg_B.ObjList.vision_36_obj.obj_angleOfCenter.centerAngle = |
| 31700 | fusionAlg_B.Selector35.OBJ_Angle_Mid; |
| 31701 | fusionAlg_B.ObjList.vision_36_obj.obj_angleOfCenter.centerAngleVariance = |
| 31702 | fusionAlg_B.Selector35.OBJ_Angle_Mid_STD; |
| 31703 | |
| 31704 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' */ |
| 31705 | fusionAlg_B.ObjList.vision_36_obj.obj_acceleration.Ax = |
| 31706 | fusionAlg_B.Selector35.OBJ_Abs_Long_Acc; |
| 31707 | fusionAlg_B.ObjList.vision_36_obj.obj_acceleration.AxVariance = |
| 31708 | fusionAlg_B.Selector35.OBJ_Abs_Long_Acc_STD; |
| 31709 | fusionAlg_B.ObjList.vision_36_obj.obj_acceleration.Ay = |
| 31710 | fusionAlg_B.Selector35.OBJ_Abs_Lat_Acc; |
| 31711 | fusionAlg_B.ObjList.vision_36_obj.obj_acceleration.AyVariance = |
| 31712 | fusionAlg_B.Selector35.OBJ_Abs_Lat_Acc_STD; |
| 31713 | |
| 31714 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' */ |
| 31715 | fusionAlg_B.ObjList.vision_36_obj.AyVariance.length = |
| 31716 | fusionAlg_B.Selector35.OBJ_Length; |
| 31717 | fusionAlg_B.ObjList.vision_36_obj.AyVariance.width = |
| 31718 | fusionAlg_B.Selector35.OBJ_Width; |
| 31719 | fusionAlg_B.ObjList.vision_36_obj.AyVariance.height = |
| 31720 | fusionAlg_B.Selector35.OBJ_Height; |
| 31721 | |
| 31722 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' incorporates: |
| 31723 | * Constant: '<S600>/Constant1' |
| 31724 | * Constant: '<S600>/Constant2' |
| 31725 | * Constant: '<S600>/Constant3' |
| 31726 | */ |
| 31727 | fusionAlg_B.ObjList.vision_36_obj.reserved1.reserved0 = |
| 31728 | fusionAlg_P_g.Constant2_Value_ee; |
| 31729 | fusionAlg_B.ObjList.vision_36_obj.reserved1.reserved1 = |
| 31730 | fusionAlg_P_g.Constant1_Value_jd4; |
| 31731 | fusionAlg_B.ObjList.vision_36_obj.reserved1.reserved2 = |
| 31732 | fusionAlg_P_g.Constant3_Value_gq; |
| 31733 | |
| 31734 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' incorporates: |
| 31735 | * Constant: '<S601>/Constant5' |
| 31736 | * Constant: '<S601>/Constant6' |
| 31737 | */ |
| 31738 | fusionAlg_B.ObjList.vision_36_obj.reserved2.reserved0 = |
| 31739 | fusionAlg_P_g.Constant5_Value_hp; |
| 31740 | fusionAlg_B.ObjList.vision_36_obj.reserved2.reserved1 = |
| 31741 | fusionAlg_P_g.Constant6_Value_ji; |
| 31742 | |
| 31743 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_35' incorporates: |
| 31744 | * Constant: '<S261>/Constant' |
| 31745 | * Constant: '<S261>/Constant1' |
| 31746 | * Constant: '<S261>/Constant2' |
| 31747 | * Constant: '<S261>/Constant3' |
| 31748 | * Constant: '<S261>/Constant4' |
| 31749 | */ |
| 31750 | fusionAlg_B.ObjList.vision_36_obj.obj_type = fusionAlg_B.Obj_Type_fy; |
| 31751 | fusionAlg_B.ObjList.vision_36_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_e1; |
| 31752 | fusionAlg_B.ObjList.vision_36_obj.obj_TTC = fusionAlg_B.Selector35.OBJ_Inv_TTC; |
| 31753 | fusionAlg_B.ObjList.vision_36_obj.obj_TTCVariance = |
| 31754 | fusionAlg_B.Selector35.OBJ_Inv_TTC_STD; |
| 31755 | fusionAlg_B.ObjList.vision_36_obj.obj_existProb = |
| 31756 | fusionAlg_P_g.Constant_Value_bo; |
| 31757 | fusionAlg_B.ObjList.vision_36_obj.obj_angleOfObject = |
| 31758 | fusionAlg_P_g.Constant1_Value_f5; |
| 31759 | fusionAlg_B.ObjList.vision_36_obj.obj_Heading = |
| 31760 | fusionAlg_B.Selector35.OBJ_Heading; |
| 31761 | fusionAlg_B.ObjList.vision_36_obj.obj_Heading_STD = |
| 31762 | fusionAlg_P_g.Constant2_Value_mp; |
| 31763 | fusionAlg_B.ObjList.vision_36_obj.obj_Heading_V = |
| 31764 | fusionAlg_P_g.Constant3_Value_ne; |
| 31765 | fusionAlg_B.ObjList.vision_36_obj.obj_Heading_STD_V = |
| 31766 | fusionAlg_P_g.Constant4_Value_l1; |
| 31767 | |
| 31768 | /* Selector: '<S223>/Selector36' incorporates: |
| 31769 | * Constant: '<S223>/Constant36' |
| 31770 | */ |
| 31771 | fusionAlg_B.Selector36 = rtu_EyeQ4_Info_st-> |
| 31772 | OBJ_BUS[fusionAlg_P_g.Constant36_Value_e]; |
| 31773 | |
| 31774 | /* DataTypeConversion: '<S262>/Data Type Conversion' */ |
| 31775 | tmp = (real32_T)floor(fusionAlg_B.Selector36.OBJ_ID); |
| 31776 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31777 | tmp = 0.0F; |
| 31778 | } else { |
| 31779 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31780 | } |
| 31781 | |
| 31782 | fusionAlg_B.ObjList.vision_37_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 31783 | (uint32_T)-tmp : (uint32_T)tmp; |
| 31784 | |
| 31785 | /* End of DataTypeConversion: '<S262>/Data Type Conversion' */ |
| 31786 | |
| 31787 | /* Lookup_n-D: '<S613>/1-D Lookup Table' */ |
| 31788 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector36.OBJ_Measuring_Status, |
| 31789 | fusionAlg_P_g.uDLookupTable_bp01Data_bc, 7U); |
| 31790 | fusionAlg_B.Obj_Status_fo = fusionAlg_P_g.uDLookupTable_tableData_kp[bpIdx]; |
| 31791 | |
| 31792 | /* DataTypeConversion: '<S613>/Data Type Conversion1' */ |
| 31793 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_fo); |
| 31794 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31795 | tmp = 0.0F; |
| 31796 | } else { |
| 31797 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31798 | } |
| 31799 | |
| 31800 | fusionAlg_B.ObjList.vision_37_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 31801 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 31802 | |
| 31803 | /* End of DataTypeConversion: '<S613>/Data Type Conversion1' */ |
| 31804 | |
| 31805 | /* DataTypeConversion: '<S604>/Data Type Conversion' */ |
| 31806 | tmp = (real32_T)floor(fusionAlg_B.Selector36.OBJ_Object_Age); |
| 31807 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31808 | tmp = 0.0F; |
| 31809 | } else { |
| 31810 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 31811 | } |
| 31812 | |
| 31813 | fusionAlg_B.measureAge_ab = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 31814 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 31815 | |
| 31816 | /* End of DataTypeConversion: '<S604>/Data Type Conversion' */ |
| 31817 | |
| 31818 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' incorporates: |
| 31819 | * Constant: '<S604>/Constant' |
| 31820 | * Constant: '<S604>/Constant1' |
| 31821 | */ |
| 31822 | fusionAlg_B.ObjList.vision_37_obj.obj_stageAge.totalAge = |
| 31823 | fusionAlg_B.measureAge_ab; |
| 31824 | fusionAlg_B.ObjList.vision_37_obj.obj_stageAge.initAge = |
| 31825 | fusionAlg_P_g.Constant_Value_jz; |
| 31826 | fusionAlg_B.ObjList.vision_37_obj.obj_stageAge.measureAge = |
| 31827 | fusionAlg_B.measureAge_ab; |
| 31828 | fusionAlg_B.ObjList.vision_37_obj.obj_stageAge.predictAge = |
| 31829 | fusionAlg_P_g.Constant1_Value_l0; |
| 31830 | |
| 31831 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' incorporates: |
| 31832 | * Constant: '<S605>/Constant' |
| 31833 | * Constant: '<S605>/Constant1' |
| 31834 | * Constant: '<S605>/Constant2' |
| 31835 | * Constant: '<S605>/Constant3' |
| 31836 | */ |
| 31837 | fusionAlg_B.ObjList.vision_37_obj.obj_boundary.X1 = |
| 31838 | fusionAlg_P_g.Constant_Value_hk; |
| 31839 | fusionAlg_B.ObjList.vision_37_obj.obj_boundary.Y1 = |
| 31840 | fusionAlg_P_g.Constant1_Value_jp; |
| 31841 | fusionAlg_B.ObjList.vision_37_obj.obj_boundary.X2 = |
| 31842 | fusionAlg_P_g.Constant2_Value_aci; |
| 31843 | fusionAlg_B.ObjList.vision_37_obj.obj_boundary.Y2 = |
| 31844 | fusionAlg_P_g.Constant3_Value_fl; |
| 31845 | |
| 31846 | /* Lookup_n-D: '<S614>/1-D Lookup Table' */ |
| 31847 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector36.OBJ_Object_Class, |
| 31848 | fusionAlg_P_g.uDLookupTable_bp01Data_id, 8U); |
| 31849 | fusionAlg_B.Obj_Status_dr = fusionAlg_P_g.uDLookupTable_tableData_hp[bpIdx]; |
| 31850 | |
| 31851 | /* DataTypeConversion: '<S614>/Data Type Conversion2' */ |
| 31852 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_dr); |
| 31853 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31854 | tmp = 0.0F; |
| 31855 | } else { |
| 31856 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31857 | } |
| 31858 | |
| 31859 | fusionAlg_B.Obj_Type_k = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31860 | (uint32_T)tmp; |
| 31861 | |
| 31862 | /* End of DataTypeConversion: '<S614>/Data Type Conversion2' */ |
| 31863 | |
| 31864 | /* DataTypeConversion: '<S262>/Data Type Conversion3' */ |
| 31865 | tmp = (real32_T)floor(fusionAlg_B.Selector36.OBJ_Class_Probability); |
| 31866 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31867 | tmp = 0.0F; |
| 31868 | } else { |
| 31869 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31870 | } |
| 31871 | |
| 31872 | fusionAlg_B.Obj_TypeConf_gh = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 31873 | (uint32_T)tmp; |
| 31874 | |
| 31875 | /* End of DataTypeConversion: '<S262>/Data Type Conversion3' */ |
| 31876 | |
| 31877 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' */ |
| 31878 | fusionAlg_B.ObjList.vision_37_obj.obj_coordinate.lateral = |
| 31879 | fusionAlg_B.Selector36.OBJ_Lat_Distance; |
| 31880 | fusionAlg_B.ObjList.vision_37_obj.obj_coordinate.lateralVariance = |
| 31881 | fusionAlg_B.Selector36.OBJ_Lat_Distance_STD; |
| 31882 | fusionAlg_B.ObjList.vision_37_obj.obj_coordinate.longitudinal = |
| 31883 | fusionAlg_B.Selector36.OBJ_Long_Distance; |
| 31884 | fusionAlg_B.ObjList.vision_37_obj.obj_coordinate.longitudinalVariance = |
| 31885 | fusionAlg_B.Selector36.OBJ_Long_Distance_STD; |
| 31886 | |
| 31887 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' */ |
| 31888 | fusionAlg_B.ObjList.vision_37_obj.obj_velocity.Vx = |
| 31889 | fusionAlg_B.Selector36.OBJ_Abs_Long_Velocity; |
| 31890 | fusionAlg_B.ObjList.vision_37_obj.obj_velocity.VxVariance = |
| 31891 | fusionAlg_B.Selector36.OBJ_Abs_Long_Velocity_STD; |
| 31892 | fusionAlg_B.ObjList.vision_37_obj.obj_velocity.Vy = |
| 31893 | fusionAlg_B.Selector36.OBJ_Abs_Lat_Velocity; |
| 31894 | fusionAlg_B.ObjList.vision_37_obj.obj_velocity.VyVariance = |
| 31895 | fusionAlg_B.Selector36.OBJ_Abs_Lat_Velocity_STD; |
| 31896 | |
| 31897 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' */ |
| 31898 | fusionAlg_B.ObjList.vision_37_obj.obj_angleOfCenter.centerAngle = |
| 31899 | fusionAlg_B.Selector36.OBJ_Angle_Mid; |
| 31900 | fusionAlg_B.ObjList.vision_37_obj.obj_angleOfCenter.centerAngleVariance = |
| 31901 | fusionAlg_B.Selector36.OBJ_Angle_Mid_STD; |
| 31902 | |
| 31903 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' */ |
| 31904 | fusionAlg_B.ObjList.vision_37_obj.obj_acceleration.Ax = |
| 31905 | fusionAlg_B.Selector36.OBJ_Abs_Long_Acc; |
| 31906 | fusionAlg_B.ObjList.vision_37_obj.obj_acceleration.AxVariance = |
| 31907 | fusionAlg_B.Selector36.OBJ_Abs_Long_Acc_STD; |
| 31908 | fusionAlg_B.ObjList.vision_37_obj.obj_acceleration.Ay = |
| 31909 | fusionAlg_B.Selector36.OBJ_Abs_Lat_Acc; |
| 31910 | fusionAlg_B.ObjList.vision_37_obj.obj_acceleration.AyVariance = |
| 31911 | fusionAlg_B.Selector36.OBJ_Abs_Lat_Acc_STD; |
| 31912 | |
| 31913 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' */ |
| 31914 | fusionAlg_B.ObjList.vision_37_obj.AyVariance.length = |
| 31915 | fusionAlg_B.Selector36.OBJ_Length; |
| 31916 | fusionAlg_B.ObjList.vision_37_obj.AyVariance.width = |
| 31917 | fusionAlg_B.Selector36.OBJ_Width; |
| 31918 | fusionAlg_B.ObjList.vision_37_obj.AyVariance.height = |
| 31919 | fusionAlg_B.Selector36.OBJ_Height; |
| 31920 | |
| 31921 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' incorporates: |
| 31922 | * Constant: '<S611>/Constant1' |
| 31923 | * Constant: '<S611>/Constant2' |
| 31924 | * Constant: '<S611>/Constant3' |
| 31925 | */ |
| 31926 | fusionAlg_B.ObjList.vision_37_obj.reserved1.reserved0 = |
| 31927 | fusionAlg_P_g.Constant2_Value_gf; |
| 31928 | fusionAlg_B.ObjList.vision_37_obj.reserved1.reserved1 = |
| 31929 | fusionAlg_P_g.Constant1_Value_pc; |
| 31930 | fusionAlg_B.ObjList.vision_37_obj.reserved1.reserved2 = |
| 31931 | fusionAlg_P_g.Constant3_Value_azx; |
| 31932 | |
| 31933 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' incorporates: |
| 31934 | * Constant: '<S612>/Constant5' |
| 31935 | * Constant: '<S612>/Constant6' |
| 31936 | */ |
| 31937 | fusionAlg_B.ObjList.vision_37_obj.reserved2.reserved0 = |
| 31938 | fusionAlg_P_g.Constant5_Value_fxt; |
| 31939 | fusionAlg_B.ObjList.vision_37_obj.reserved2.reserved1 = |
| 31940 | fusionAlg_P_g.Constant6_Value_bin; |
| 31941 | |
| 31942 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_36' incorporates: |
| 31943 | * Constant: '<S262>/Constant' |
| 31944 | * Constant: '<S262>/Constant1' |
| 31945 | * Constant: '<S262>/Constant2' |
| 31946 | * Constant: '<S262>/Constant3' |
| 31947 | * Constant: '<S262>/Constant4' |
| 31948 | */ |
| 31949 | fusionAlg_B.ObjList.vision_37_obj.obj_type = fusionAlg_B.Obj_Type_k; |
| 31950 | fusionAlg_B.ObjList.vision_37_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_gh; |
| 31951 | fusionAlg_B.ObjList.vision_37_obj.obj_TTC = fusionAlg_B.Selector36.OBJ_Inv_TTC; |
| 31952 | fusionAlg_B.ObjList.vision_37_obj.obj_TTCVariance = |
| 31953 | fusionAlg_B.Selector36.OBJ_Inv_TTC_STD; |
| 31954 | fusionAlg_B.ObjList.vision_37_obj.obj_existProb = |
| 31955 | fusionAlg_P_g.Constant_Value_aw; |
| 31956 | fusionAlg_B.ObjList.vision_37_obj.obj_angleOfObject = |
| 31957 | fusionAlg_P_g.Constant1_Value_ad; |
| 31958 | fusionAlg_B.ObjList.vision_37_obj.obj_Heading = |
| 31959 | fusionAlg_B.Selector36.OBJ_Heading; |
| 31960 | fusionAlg_B.ObjList.vision_37_obj.obj_Heading_STD = |
| 31961 | fusionAlg_P_g.Constant2_Value_lk; |
| 31962 | fusionAlg_B.ObjList.vision_37_obj.obj_Heading_V = |
| 31963 | fusionAlg_P_g.Constant3_Value_ktd; |
| 31964 | fusionAlg_B.ObjList.vision_37_obj.obj_Heading_STD_V = |
| 31965 | fusionAlg_P_g.Constant4_Value_hp; |
| 31966 | |
| 31967 | /* Selector: '<S223>/Selector37' incorporates: |
| 31968 | * Constant: '<S223>/Constant37' |
| 31969 | */ |
| 31970 | fusionAlg_B.Selector37 = rtu_EyeQ4_Info_st-> |
| 31971 | OBJ_BUS[fusionAlg_P_g.Constant37_Value_l]; |
| 31972 | |
| 31973 | /* DataTypeConversion: '<S263>/Data Type Conversion' */ |
| 31974 | tmp = (real32_T)floor(fusionAlg_B.Selector37.OBJ_ID); |
| 31975 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31976 | tmp = 0.0F; |
| 31977 | } else { |
| 31978 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31979 | } |
| 31980 | |
| 31981 | fusionAlg_B.ObjList.vision_38_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 31982 | (uint32_T)-tmp : (uint32_T)tmp; |
| 31983 | |
| 31984 | /* End of DataTypeConversion: '<S263>/Data Type Conversion' */ |
| 31985 | |
| 31986 | /* Lookup_n-D: '<S624>/1-D Lookup Table' */ |
| 31987 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector37.OBJ_Measuring_Status, |
| 31988 | fusionAlg_P_g.uDLookupTable_bp01Data_nc, 7U); |
| 31989 | fusionAlg_B.Obj_Status_gw = fusionAlg_P_g.uDLookupTable_tableData_fc[bpIdx]; |
| 31990 | |
| 31991 | /* DataTypeConversion: '<S624>/Data Type Conversion1' */ |
| 31992 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_gw); |
| 31993 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 31994 | tmp = 0.0F; |
| 31995 | } else { |
| 31996 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 31997 | } |
| 31998 | |
| 31999 | fusionAlg_B.ObjList.vision_38_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 32000 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 32001 | |
| 32002 | /* End of DataTypeConversion: '<S624>/Data Type Conversion1' */ |
| 32003 | |
| 32004 | /* DataTypeConversion: '<S615>/Data Type Conversion' */ |
| 32005 | tmp = (real32_T)floor(fusionAlg_B.Selector37.OBJ_Object_Age); |
| 32006 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32007 | tmp = 0.0F; |
| 32008 | } else { |
| 32009 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 32010 | } |
| 32011 | |
| 32012 | fusionAlg_B.measureAge_gj = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 32013 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 32014 | |
| 32015 | /* End of DataTypeConversion: '<S615>/Data Type Conversion' */ |
| 32016 | |
| 32017 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' incorporates: |
| 32018 | * Constant: '<S615>/Constant' |
| 32019 | * Constant: '<S615>/Constant1' |
| 32020 | */ |
| 32021 | fusionAlg_B.ObjList.vision_38_obj.obj_stageAge.totalAge = |
| 32022 | fusionAlg_B.measureAge_gj; |
| 32023 | fusionAlg_B.ObjList.vision_38_obj.obj_stageAge.initAge = |
| 32024 | fusionAlg_P_g.Constant_Value_ix; |
| 32025 | fusionAlg_B.ObjList.vision_38_obj.obj_stageAge.measureAge = |
| 32026 | fusionAlg_B.measureAge_gj; |
| 32027 | fusionAlg_B.ObjList.vision_38_obj.obj_stageAge.predictAge = |
| 32028 | fusionAlg_P_g.Constant1_Value_hs; |
| 32029 | |
| 32030 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' incorporates: |
| 32031 | * Constant: '<S616>/Constant' |
| 32032 | * Constant: '<S616>/Constant1' |
| 32033 | * Constant: '<S616>/Constant2' |
| 32034 | * Constant: '<S616>/Constant3' |
| 32035 | */ |
| 32036 | fusionAlg_B.ObjList.vision_38_obj.obj_boundary.X1 = |
| 32037 | fusionAlg_P_g.Constant_Value_e4; |
| 32038 | fusionAlg_B.ObjList.vision_38_obj.obj_boundary.Y1 = |
| 32039 | fusionAlg_P_g.Constant1_Value_d1; |
| 32040 | fusionAlg_B.ObjList.vision_38_obj.obj_boundary.X2 = |
| 32041 | fusionAlg_P_g.Constant2_Value_bp2; |
| 32042 | fusionAlg_B.ObjList.vision_38_obj.obj_boundary.Y2 = |
| 32043 | fusionAlg_P_g.Constant3_Value_oo; |
| 32044 | |
| 32045 | /* Lookup_n-D: '<S625>/1-D Lookup Table' */ |
| 32046 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector37.OBJ_Object_Class, |
| 32047 | fusionAlg_P_g.uDLookupTable_bp01Data_ld, 8U); |
| 32048 | fusionAlg_B.Obj_Status_ber = fusionAlg_P_g.uDLookupTable_tableData_nc[bpIdx]; |
| 32049 | |
| 32050 | /* DataTypeConversion: '<S625>/Data Type Conversion2' */ |
| 32051 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ber); |
| 32052 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32053 | tmp = 0.0F; |
| 32054 | } else { |
| 32055 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32056 | } |
| 32057 | |
| 32058 | fusionAlg_B.Obj_Type_lk = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 32059 | (uint32_T)tmp; |
| 32060 | |
| 32061 | /* End of DataTypeConversion: '<S625>/Data Type Conversion2' */ |
| 32062 | |
| 32063 | /* DataTypeConversion: '<S263>/Data Type Conversion3' */ |
| 32064 | tmp = (real32_T)floor(fusionAlg_B.Selector37.OBJ_Class_Probability); |
| 32065 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32066 | tmp = 0.0F; |
| 32067 | } else { |
| 32068 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32069 | } |
| 32070 | |
| 32071 | fusionAlg_B.Obj_TypeConf_ou = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 32072 | (uint32_T)tmp; |
| 32073 | |
| 32074 | /* End of DataTypeConversion: '<S263>/Data Type Conversion3' */ |
| 32075 | |
| 32076 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' */ |
| 32077 | fusionAlg_B.ObjList.vision_38_obj.obj_coordinate.lateral = |
| 32078 | fusionAlg_B.Selector37.OBJ_Lat_Distance; |
| 32079 | fusionAlg_B.ObjList.vision_38_obj.obj_coordinate.lateralVariance = |
| 32080 | fusionAlg_B.Selector37.OBJ_Lat_Distance_STD; |
| 32081 | fusionAlg_B.ObjList.vision_38_obj.obj_coordinate.longitudinal = |
| 32082 | fusionAlg_B.Selector37.OBJ_Long_Distance; |
| 32083 | fusionAlg_B.ObjList.vision_38_obj.obj_coordinate.longitudinalVariance = |
| 32084 | fusionAlg_B.Selector37.OBJ_Long_Distance_STD; |
| 32085 | |
| 32086 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' */ |
| 32087 | fusionAlg_B.ObjList.vision_38_obj.obj_velocity.Vx = |
| 32088 | fusionAlg_B.Selector37.OBJ_Abs_Long_Velocity; |
| 32089 | fusionAlg_B.ObjList.vision_38_obj.obj_velocity.VxVariance = |
| 32090 | fusionAlg_B.Selector37.OBJ_Abs_Long_Velocity_STD; |
| 32091 | fusionAlg_B.ObjList.vision_38_obj.obj_velocity.Vy = |
| 32092 | fusionAlg_B.Selector37.OBJ_Abs_Lat_Velocity; |
| 32093 | fusionAlg_B.ObjList.vision_38_obj.obj_velocity.VyVariance = |
| 32094 | fusionAlg_B.Selector37.OBJ_Abs_Lat_Velocity_STD; |
| 32095 | |
| 32096 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' */ |
| 32097 | fusionAlg_B.ObjList.vision_38_obj.obj_angleOfCenter.centerAngle = |
| 32098 | fusionAlg_B.Selector37.OBJ_Angle_Mid; |
| 32099 | fusionAlg_B.ObjList.vision_38_obj.obj_angleOfCenter.centerAngleVariance = |
| 32100 | fusionAlg_B.Selector37.OBJ_Angle_Mid_STD; |
| 32101 | |
| 32102 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' */ |
| 32103 | fusionAlg_B.ObjList.vision_38_obj.obj_acceleration.Ax = |
| 32104 | fusionAlg_B.Selector37.OBJ_Abs_Long_Acc; |
| 32105 | fusionAlg_B.ObjList.vision_38_obj.obj_acceleration.AxVariance = |
| 32106 | fusionAlg_B.Selector37.OBJ_Abs_Long_Acc_STD; |
| 32107 | fusionAlg_B.ObjList.vision_38_obj.obj_acceleration.Ay = |
| 32108 | fusionAlg_B.Selector37.OBJ_Abs_Lat_Acc; |
| 32109 | fusionAlg_B.ObjList.vision_38_obj.obj_acceleration.AyVariance = |
| 32110 | fusionAlg_B.Selector37.OBJ_Abs_Lat_Acc_STD; |
| 32111 | |
| 32112 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' */ |
| 32113 | fusionAlg_B.ObjList.vision_38_obj.AyVariance.length = |
| 32114 | fusionAlg_B.Selector37.OBJ_Length; |
| 32115 | fusionAlg_B.ObjList.vision_38_obj.AyVariance.width = |
| 32116 | fusionAlg_B.Selector37.OBJ_Width; |
| 32117 | fusionAlg_B.ObjList.vision_38_obj.AyVariance.height = |
| 32118 | fusionAlg_B.Selector37.OBJ_Height; |
| 32119 | |
| 32120 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' incorporates: |
| 32121 | * Constant: '<S622>/Constant1' |
| 32122 | * Constant: '<S622>/Constant2' |
| 32123 | * Constant: '<S622>/Constant3' |
| 32124 | */ |
| 32125 | fusionAlg_B.ObjList.vision_38_obj.reserved1.reserved0 = |
| 32126 | fusionAlg_P_g.Constant2_Value_oe; |
| 32127 | fusionAlg_B.ObjList.vision_38_obj.reserved1.reserved1 = |
| 32128 | fusionAlg_P_g.Constant1_Value_dmu; |
| 32129 | fusionAlg_B.ObjList.vision_38_obj.reserved1.reserved2 = |
| 32130 | fusionAlg_P_g.Constant3_Value_fc; |
| 32131 | |
| 32132 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' incorporates: |
| 32133 | * Constant: '<S623>/Constant5' |
| 32134 | * Constant: '<S623>/Constant6' |
| 32135 | */ |
| 32136 | fusionAlg_B.ObjList.vision_38_obj.reserved2.reserved0 = |
| 32137 | fusionAlg_P_g.Constant5_Value_nc; |
| 32138 | fusionAlg_B.ObjList.vision_38_obj.reserved2.reserved1 = |
| 32139 | fusionAlg_P_g.Constant6_Value_k4; |
| 32140 | |
| 32141 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_37' incorporates: |
| 32142 | * Constant: '<S263>/Constant' |
| 32143 | * Constant: '<S263>/Constant1' |
| 32144 | * Constant: '<S263>/Constant2' |
| 32145 | * Constant: '<S263>/Constant3' |
| 32146 | * Constant: '<S263>/Constant4' |
| 32147 | */ |
| 32148 | fusionAlg_B.ObjList.vision_38_obj.obj_type = fusionAlg_B.Obj_Type_lk; |
| 32149 | fusionAlg_B.ObjList.vision_38_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_ou; |
| 32150 | fusionAlg_B.ObjList.vision_38_obj.obj_TTC = fusionAlg_B.Selector37.OBJ_Inv_TTC; |
| 32151 | fusionAlg_B.ObjList.vision_38_obj.obj_TTCVariance = |
| 32152 | fusionAlg_B.Selector37.OBJ_Inv_TTC_STD; |
| 32153 | fusionAlg_B.ObjList.vision_38_obj.obj_existProb = |
| 32154 | fusionAlg_P_g.Constant_Value_m2o; |
| 32155 | fusionAlg_B.ObjList.vision_38_obj.obj_angleOfObject = |
| 32156 | fusionAlg_P_g.Constant1_Value_n2b; |
| 32157 | fusionAlg_B.ObjList.vision_38_obj.obj_Heading = |
| 32158 | fusionAlg_B.Selector37.OBJ_Heading; |
| 32159 | fusionAlg_B.ObjList.vision_38_obj.obj_Heading_STD = |
| 32160 | fusionAlg_P_g.Constant2_Value_fv; |
| 32161 | fusionAlg_B.ObjList.vision_38_obj.obj_Heading_V = |
| 32162 | fusionAlg_P_g.Constant3_Value_kd; |
| 32163 | fusionAlg_B.ObjList.vision_38_obj.obj_Heading_STD_V = |
| 32164 | fusionAlg_P_g.Constant4_Value_er; |
| 32165 | |
| 32166 | /* Selector: '<S223>/Selector38' incorporates: |
| 32167 | * Constant: '<S223>/Constant38' |
| 32168 | */ |
| 32169 | fusionAlg_B.Selector38 = rtu_EyeQ4_Info_st-> |
| 32170 | OBJ_BUS[fusionAlg_P_g.Constant38_Value_a]; |
| 32171 | |
| 32172 | /* DataTypeConversion: '<S264>/Data Type Conversion' */ |
| 32173 | tmp = (real32_T)floor(fusionAlg_B.Selector38.OBJ_ID); |
| 32174 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32175 | tmp = 0.0F; |
| 32176 | } else { |
| 32177 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32178 | } |
| 32179 | |
| 32180 | fusionAlg_B.ObjList.vision_39_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32181 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32182 | |
| 32183 | /* End of DataTypeConversion: '<S264>/Data Type Conversion' */ |
| 32184 | |
| 32185 | /* Lookup_n-D: '<S635>/1-D Lookup Table' */ |
| 32186 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector38.OBJ_Measuring_Status, |
| 32187 | fusionAlg_P_g.uDLookupTable_bp01Data_d0, 7U); |
| 32188 | fusionAlg_B.Obj_Status_gwq = fusionAlg_P_g.uDLookupTable_tableData_h0[bpIdx]; |
| 32189 | |
| 32190 | /* DataTypeConversion: '<S635>/Data Type Conversion1' */ |
| 32191 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_gwq); |
| 32192 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32193 | tmp = 0.0F; |
| 32194 | } else { |
| 32195 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32196 | } |
| 32197 | |
| 32198 | fusionAlg_B.ObjList.vision_39_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 32199 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 32200 | |
| 32201 | /* End of DataTypeConversion: '<S635>/Data Type Conversion1' */ |
| 32202 | |
| 32203 | /* DataTypeConversion: '<S626>/Data Type Conversion' */ |
| 32204 | tmp = (real32_T)floor(fusionAlg_B.Selector38.OBJ_Object_Age); |
| 32205 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32206 | tmp = 0.0F; |
| 32207 | } else { |
| 32208 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 32209 | } |
| 32210 | |
| 32211 | fusionAlg_B.measureAge_pe = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 32212 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 32213 | |
| 32214 | /* End of DataTypeConversion: '<S626>/Data Type Conversion' */ |
| 32215 | |
| 32216 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' incorporates: |
| 32217 | * Constant: '<S626>/Constant' |
| 32218 | * Constant: '<S626>/Constant1' |
| 32219 | */ |
| 32220 | fusionAlg_B.ObjList.vision_39_obj.obj_stageAge.totalAge = |
| 32221 | fusionAlg_B.measureAge_pe; |
| 32222 | fusionAlg_B.ObjList.vision_39_obj.obj_stageAge.initAge = |
| 32223 | fusionAlg_P_g.Constant_Value_n1; |
| 32224 | fusionAlg_B.ObjList.vision_39_obj.obj_stageAge.measureAge = |
| 32225 | fusionAlg_B.measureAge_pe; |
| 32226 | fusionAlg_B.ObjList.vision_39_obj.obj_stageAge.predictAge = |
| 32227 | fusionAlg_P_g.Constant1_Value_hv; |
| 32228 | |
| 32229 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' incorporates: |
| 32230 | * Constant: '<S627>/Constant' |
| 32231 | * Constant: '<S627>/Constant1' |
| 32232 | * Constant: '<S627>/Constant2' |
| 32233 | * Constant: '<S627>/Constant3' |
| 32234 | */ |
| 32235 | fusionAlg_B.ObjList.vision_39_obj.obj_boundary.X1 = |
| 32236 | fusionAlg_P_g.Constant_Value_lrs; |
| 32237 | fusionAlg_B.ObjList.vision_39_obj.obj_boundary.Y1 = |
| 32238 | fusionAlg_P_g.Constant1_Value_n4; |
| 32239 | fusionAlg_B.ObjList.vision_39_obj.obj_boundary.X2 = |
| 32240 | fusionAlg_P_g.Constant2_Value_mt; |
| 32241 | fusionAlg_B.ObjList.vision_39_obj.obj_boundary.Y2 = |
| 32242 | fusionAlg_P_g.Constant3_Value_mn; |
| 32243 | |
| 32244 | /* Lookup_n-D: '<S636>/1-D Lookup Table' */ |
| 32245 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector38.OBJ_Object_Class, |
| 32246 | fusionAlg_P_g.uDLookupTable_bp01Data_jv, 8U); |
| 32247 | fusionAlg_B.Obj_Status_ls = fusionAlg_P_g.uDLookupTable_tableData_iz[bpIdx]; |
| 32248 | |
| 32249 | /* DataTypeConversion: '<S636>/Data Type Conversion2' */ |
| 32250 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ls); |
| 32251 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32252 | tmp = 0.0F; |
| 32253 | } else { |
| 32254 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32255 | } |
| 32256 | |
| 32257 | fusionAlg_B.Obj_Type_dv = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 32258 | (uint32_T)tmp; |
| 32259 | |
| 32260 | /* End of DataTypeConversion: '<S636>/Data Type Conversion2' */ |
| 32261 | |
| 32262 | /* DataTypeConversion: '<S264>/Data Type Conversion3' */ |
| 32263 | tmp = (real32_T)floor(fusionAlg_B.Selector38.OBJ_Class_Probability); |
| 32264 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32265 | tmp = 0.0F; |
| 32266 | } else { |
| 32267 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32268 | } |
| 32269 | |
| 32270 | fusionAlg_B.Obj_TypeConf_nb = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 32271 | (uint32_T)tmp; |
| 32272 | |
| 32273 | /* End of DataTypeConversion: '<S264>/Data Type Conversion3' */ |
| 32274 | |
| 32275 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' */ |
| 32276 | fusionAlg_B.ObjList.vision_39_obj.obj_coordinate.lateral = |
| 32277 | fusionAlg_B.Selector38.OBJ_Lat_Distance; |
| 32278 | fusionAlg_B.ObjList.vision_39_obj.obj_coordinate.lateralVariance = |
| 32279 | fusionAlg_B.Selector38.OBJ_Lat_Distance_STD; |
| 32280 | fusionAlg_B.ObjList.vision_39_obj.obj_coordinate.longitudinal = |
| 32281 | fusionAlg_B.Selector38.OBJ_Long_Distance; |
| 32282 | fusionAlg_B.ObjList.vision_39_obj.obj_coordinate.longitudinalVariance = |
| 32283 | fusionAlg_B.Selector38.OBJ_Long_Distance_STD; |
| 32284 | |
| 32285 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' */ |
| 32286 | fusionAlg_B.ObjList.vision_39_obj.obj_velocity.Vx = |
| 32287 | fusionAlg_B.Selector38.OBJ_Abs_Long_Velocity; |
| 32288 | fusionAlg_B.ObjList.vision_39_obj.obj_velocity.VxVariance = |
| 32289 | fusionAlg_B.Selector38.OBJ_Abs_Long_Velocity_STD; |
| 32290 | fusionAlg_B.ObjList.vision_39_obj.obj_velocity.Vy = |
| 32291 | fusionAlg_B.Selector38.OBJ_Abs_Lat_Velocity; |
| 32292 | fusionAlg_B.ObjList.vision_39_obj.obj_velocity.VyVariance = |
| 32293 | fusionAlg_B.Selector38.OBJ_Abs_Lat_Velocity_STD; |
| 32294 | |
| 32295 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' */ |
| 32296 | fusionAlg_B.ObjList.vision_39_obj.obj_angleOfCenter.centerAngle = |
| 32297 | fusionAlg_B.Selector38.OBJ_Angle_Mid; |
| 32298 | fusionAlg_B.ObjList.vision_39_obj.obj_angleOfCenter.centerAngleVariance = |
| 32299 | fusionAlg_B.Selector38.OBJ_Angle_Mid_STD; |
| 32300 | |
| 32301 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' */ |
| 32302 | fusionAlg_B.ObjList.vision_39_obj.obj_acceleration.Ax = |
| 32303 | fusionAlg_B.Selector38.OBJ_Abs_Long_Acc; |
| 32304 | fusionAlg_B.ObjList.vision_39_obj.obj_acceleration.AxVariance = |
| 32305 | fusionAlg_B.Selector38.OBJ_Abs_Long_Acc_STD; |
| 32306 | fusionAlg_B.ObjList.vision_39_obj.obj_acceleration.Ay = |
| 32307 | fusionAlg_B.Selector38.OBJ_Abs_Lat_Acc; |
| 32308 | fusionAlg_B.ObjList.vision_39_obj.obj_acceleration.AyVariance = |
| 32309 | fusionAlg_B.Selector38.OBJ_Abs_Lat_Acc_STD; |
| 32310 | |
| 32311 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' */ |
| 32312 | fusionAlg_B.ObjList.vision_39_obj.AyVariance.length = |
| 32313 | fusionAlg_B.Selector38.OBJ_Length; |
| 32314 | fusionAlg_B.ObjList.vision_39_obj.AyVariance.width = |
| 32315 | fusionAlg_B.Selector38.OBJ_Width; |
| 32316 | fusionAlg_B.ObjList.vision_39_obj.AyVariance.height = |
| 32317 | fusionAlg_B.Selector38.OBJ_Height; |
| 32318 | |
| 32319 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' incorporates: |
| 32320 | * Constant: '<S633>/Constant1' |
| 32321 | * Constant: '<S633>/Constant2' |
| 32322 | * Constant: '<S633>/Constant3' |
| 32323 | */ |
| 32324 | fusionAlg_B.ObjList.vision_39_obj.reserved1.reserved0 = |
| 32325 | fusionAlg_P_g.Constant2_Value_a52; |
| 32326 | fusionAlg_B.ObjList.vision_39_obj.reserved1.reserved1 = |
| 32327 | fusionAlg_P_g.Constant1_Value_bxw; |
| 32328 | fusionAlg_B.ObjList.vision_39_obj.reserved1.reserved2 = |
| 32329 | fusionAlg_P_g.Constant3_Value_b30; |
| 32330 | |
| 32331 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' incorporates: |
| 32332 | * Constant: '<S634>/Constant5' |
| 32333 | * Constant: '<S634>/Constant6' |
| 32334 | */ |
| 32335 | fusionAlg_B.ObjList.vision_39_obj.reserved2.reserved0 = |
| 32336 | fusionAlg_P_g.Constant5_Value_n5g; |
| 32337 | fusionAlg_B.ObjList.vision_39_obj.reserved2.reserved1 = |
| 32338 | fusionAlg_P_g.Constant6_Value_lx; |
| 32339 | |
| 32340 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_38' incorporates: |
| 32341 | * Constant: '<S264>/Constant' |
| 32342 | * Constant: '<S264>/Constant1' |
| 32343 | * Constant: '<S264>/Constant2' |
| 32344 | * Constant: '<S264>/Constant3' |
| 32345 | * Constant: '<S264>/Constant4' |
| 32346 | */ |
| 32347 | fusionAlg_B.ObjList.vision_39_obj.obj_type = fusionAlg_B.Obj_Type_dv; |
| 32348 | fusionAlg_B.ObjList.vision_39_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_nb; |
| 32349 | fusionAlg_B.ObjList.vision_39_obj.obj_TTC = fusionAlg_B.Selector38.OBJ_Inv_TTC; |
| 32350 | fusionAlg_B.ObjList.vision_39_obj.obj_TTCVariance = |
| 32351 | fusionAlg_B.Selector38.OBJ_Inv_TTC_STD; |
| 32352 | fusionAlg_B.ObjList.vision_39_obj.obj_existProb = |
| 32353 | fusionAlg_P_g.Constant_Value_dy; |
| 32354 | fusionAlg_B.ObjList.vision_39_obj.obj_angleOfObject = |
| 32355 | fusionAlg_P_g.Constant1_Value_pj; |
| 32356 | fusionAlg_B.ObjList.vision_39_obj.obj_Heading = |
| 32357 | fusionAlg_B.Selector38.OBJ_Heading; |
| 32358 | fusionAlg_B.ObjList.vision_39_obj.obj_Heading_STD = |
| 32359 | fusionAlg_P_g.Constant2_Value_e2; |
| 32360 | fusionAlg_B.ObjList.vision_39_obj.obj_Heading_V = |
| 32361 | fusionAlg_P_g.Constant3_Value_ll; |
| 32362 | fusionAlg_B.ObjList.vision_39_obj.obj_Heading_STD_V = |
| 32363 | fusionAlg_P_g.Constant4_Value_gov; |
| 32364 | |
| 32365 | /* Selector: '<S223>/Selector39' incorporates: |
| 32366 | * Constant: '<S223>/Constant39' |
| 32367 | */ |
| 32368 | fusionAlg_B.Selector39 = rtu_EyeQ4_Info_st-> |
| 32369 | OBJ_BUS[fusionAlg_P_g.Constant39_Value_d]; |
| 32370 | |
| 32371 | /* DataTypeConversion: '<S266>/Data Type Conversion' */ |
| 32372 | tmp = (real32_T)floor(fusionAlg_B.Selector39.OBJ_ID); |
| 32373 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32374 | tmp = 0.0F; |
| 32375 | } else { |
| 32376 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32377 | } |
| 32378 | |
| 32379 | fusionAlg_B.ObjList.vision_40_obj.obj_ID = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32380 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32381 | |
| 32382 | /* End of DataTypeConversion: '<S266>/Data Type Conversion' */ |
| 32383 | |
| 32384 | /* Lookup_n-D: '<S657>/1-D Lookup Table' */ |
| 32385 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector39.OBJ_Measuring_Status, |
| 32386 | fusionAlg_P_g.uDLookupTable_bp01Data_bp, 7U); |
| 32387 | fusionAlg_B.Obj_Status_ep = fusionAlg_P_g.uDLookupTable_tableData_kt[bpIdx]; |
| 32388 | |
| 32389 | /* DataTypeConversion: '<S657>/Data Type Conversion1' */ |
| 32390 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_ep); |
| 32391 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32392 | tmp = 0.0F; |
| 32393 | } else { |
| 32394 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32395 | } |
| 32396 | |
| 32397 | fusionAlg_B.ObjList.vision_40_obj.obj_status = tmp < 0.0F ? (uint32_T) |
| 32398 | -(int32_T)(uint32_T)-tmp : (uint32_T)tmp; |
| 32399 | |
| 32400 | /* End of DataTypeConversion: '<S657>/Data Type Conversion1' */ |
| 32401 | |
| 32402 | /* DataTypeConversion: '<S648>/Data Type Conversion' */ |
| 32403 | tmp = (real32_T)floor(fusionAlg_B.Selector39.OBJ_Object_Age); |
| 32404 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32405 | tmp = 0.0F; |
| 32406 | } else { |
| 32407 | tmp = (real32_T)fmod(tmp, 65536.0); |
| 32408 | } |
| 32409 | |
| 32410 | fusionAlg_B.measureAge_el = (uint16_T)(tmp < 0.0F ? (int32_T)(uint16_T) |
| 32411 | -(int16_T)(uint16_T)-tmp : (int32_T)(uint16_T)tmp); |
| 32412 | |
| 32413 | /* End of DataTypeConversion: '<S648>/Data Type Conversion' */ |
| 32414 | |
| 32415 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' incorporates: |
| 32416 | * Constant: '<S648>/Constant' |
| 32417 | * Constant: '<S648>/Constant1' |
| 32418 | */ |
| 32419 | fusionAlg_B.ObjList.vision_40_obj.obj_stageAge.totalAge = |
| 32420 | fusionAlg_B.measureAge_el; |
| 32421 | fusionAlg_B.ObjList.vision_40_obj.obj_stageAge.initAge = |
| 32422 | fusionAlg_P_g.Constant_Value_o5m; |
| 32423 | fusionAlg_B.ObjList.vision_40_obj.obj_stageAge.measureAge = |
| 32424 | fusionAlg_B.measureAge_el; |
| 32425 | fusionAlg_B.ObjList.vision_40_obj.obj_stageAge.predictAge = |
| 32426 | fusionAlg_P_g.Constant1_Value_ju; |
| 32427 | |
| 32428 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' incorporates: |
| 32429 | * Constant: '<S649>/Constant' |
| 32430 | * Constant: '<S649>/Constant1' |
| 32431 | * Constant: '<S649>/Constant2' |
| 32432 | * Constant: '<S649>/Constant3' |
| 32433 | */ |
| 32434 | fusionAlg_B.ObjList.vision_40_obj.obj_boundary.X1 = |
| 32435 | fusionAlg_P_g.Constant_Value_ne; |
| 32436 | fusionAlg_B.ObjList.vision_40_obj.obj_boundary.Y1 = |
| 32437 | fusionAlg_P_g.Constant1_Value_em; |
| 32438 | fusionAlg_B.ObjList.vision_40_obj.obj_boundary.X2 = |
| 32439 | fusionAlg_P_g.Constant2_Value_bwc; |
| 32440 | fusionAlg_B.ObjList.vision_40_obj.obj_boundary.Y2 = |
| 32441 | fusionAlg_P_g.Constant3_Value_gn; |
| 32442 | |
| 32443 | /* Lookup_n-D: '<S658>/1-D Lookup Table' */ |
| 32444 | bpIdx = plook_u32f_lincka(fusionAlg_B.Selector39.OBJ_Object_Class, |
| 32445 | fusionAlg_P_g.uDLookupTable_bp01Data_gl, 8U); |
| 32446 | fusionAlg_B.Obj_Status_mc = fusionAlg_P_g.uDLookupTable_tableData_ir[bpIdx]; |
| 32447 | |
| 32448 | /* DataTypeConversion: '<S658>/Data Type Conversion2' */ |
| 32449 | tmp = (real32_T)floor(fusionAlg_B.Obj_Status_mc); |
| 32450 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32451 | tmp = 0.0F; |
| 32452 | } else { |
| 32453 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32454 | } |
| 32455 | |
| 32456 | fusionAlg_B.Obj_Type_im = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 32457 | (uint32_T)tmp; |
| 32458 | |
| 32459 | /* End of DataTypeConversion: '<S658>/Data Type Conversion2' */ |
| 32460 | |
| 32461 | /* DataTypeConversion: '<S266>/Data Type Conversion3' */ |
| 32462 | tmp = (real32_T)floor(fusionAlg_B.Selector39.OBJ_Class_Probability); |
| 32463 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32464 | tmp = 0.0F; |
| 32465 | } else { |
| 32466 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32467 | } |
| 32468 | |
| 32469 | fusionAlg_B.Obj_TypeConf_bu = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 32470 | (uint32_T)tmp; |
| 32471 | |
| 32472 | /* End of DataTypeConversion: '<S266>/Data Type Conversion3' */ |
| 32473 | |
| 32474 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' */ |
| 32475 | fusionAlg_B.ObjList.vision_40_obj.obj_coordinate.lateral = |
| 32476 | fusionAlg_B.Selector39.OBJ_Lat_Distance; |
| 32477 | fusionAlg_B.ObjList.vision_40_obj.obj_coordinate.lateralVariance = |
| 32478 | fusionAlg_B.Selector39.OBJ_Lat_Distance_STD; |
| 32479 | fusionAlg_B.ObjList.vision_40_obj.obj_coordinate.longitudinal = |
| 32480 | fusionAlg_B.Selector39.OBJ_Long_Distance; |
| 32481 | fusionAlg_B.ObjList.vision_40_obj.obj_coordinate.longitudinalVariance = |
| 32482 | fusionAlg_B.Selector39.OBJ_Long_Distance_STD; |
| 32483 | |
| 32484 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' */ |
| 32485 | fusionAlg_B.ObjList.vision_40_obj.obj_velocity.Vx = |
| 32486 | fusionAlg_B.Selector39.OBJ_Abs_Long_Velocity; |
| 32487 | fusionAlg_B.ObjList.vision_40_obj.obj_velocity.VxVariance = |
| 32488 | fusionAlg_B.Selector39.OBJ_Abs_Long_Velocity_STD; |
| 32489 | fusionAlg_B.ObjList.vision_40_obj.obj_velocity.Vy = |
| 32490 | fusionAlg_B.Selector39.OBJ_Abs_Lat_Velocity; |
| 32491 | fusionAlg_B.ObjList.vision_40_obj.obj_velocity.VyVariance = |
| 32492 | fusionAlg_B.Selector39.OBJ_Abs_Lat_Velocity_STD; |
| 32493 | |
| 32494 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' */ |
| 32495 | fusionAlg_B.ObjList.vision_40_obj.obj_angleOfCenter.centerAngle = |
| 32496 | fusionAlg_B.Selector39.OBJ_Angle_Mid; |
| 32497 | fusionAlg_B.ObjList.vision_40_obj.obj_angleOfCenter.centerAngleVariance = |
| 32498 | fusionAlg_B.Selector39.OBJ_Angle_Mid_STD; |
| 32499 | |
| 32500 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' */ |
| 32501 | fusionAlg_B.ObjList.vision_40_obj.obj_acceleration.Ax = |
| 32502 | fusionAlg_B.Selector39.OBJ_Abs_Long_Acc; |
| 32503 | fusionAlg_B.ObjList.vision_40_obj.obj_acceleration.AxVariance = |
| 32504 | fusionAlg_B.Selector39.OBJ_Abs_Long_Acc_STD; |
| 32505 | fusionAlg_B.ObjList.vision_40_obj.obj_acceleration.Ay = |
| 32506 | fusionAlg_B.Selector39.OBJ_Abs_Lat_Acc; |
| 32507 | fusionAlg_B.ObjList.vision_40_obj.obj_acceleration.AyVariance = |
| 32508 | fusionAlg_B.Selector39.OBJ_Abs_Lat_Acc_STD; |
| 32509 | |
| 32510 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' */ |
| 32511 | fusionAlg_B.ObjList.vision_40_obj.AyVariance.length = |
| 32512 | fusionAlg_B.Selector39.OBJ_Length; |
| 32513 | fusionAlg_B.ObjList.vision_40_obj.AyVariance.width = |
| 32514 | fusionAlg_B.Selector39.OBJ_Width; |
| 32515 | fusionAlg_B.ObjList.vision_40_obj.AyVariance.height = |
| 32516 | fusionAlg_B.Selector39.OBJ_Height; |
| 32517 | |
| 32518 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' incorporates: |
| 32519 | * Constant: '<S655>/Constant1' |
| 32520 | * Constant: '<S655>/Constant2' |
| 32521 | * Constant: '<S655>/Constant3' |
| 32522 | */ |
| 32523 | fusionAlg_B.ObjList.vision_40_obj.reserved1.reserved0 = |
| 32524 | fusionAlg_P_g.Constant2_Value_hit; |
| 32525 | fusionAlg_B.ObjList.vision_40_obj.reserved1.reserved1 = |
| 32526 | fusionAlg_P_g.Constant1_Value_let; |
| 32527 | fusionAlg_B.ObjList.vision_40_obj.reserved1.reserved2 = |
| 32528 | fusionAlg_P_g.Constant3_Value_bk; |
| 32529 | |
| 32530 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' incorporates: |
| 32531 | * Constant: '<S656>/Constant5' |
| 32532 | * Constant: '<S656>/Constant6' |
| 32533 | */ |
| 32534 | fusionAlg_B.ObjList.vision_40_obj.reserved2.reserved0 = |
| 32535 | fusionAlg_P_g.Constant5_Value_lw; |
| 32536 | fusionAlg_B.ObjList.vision_40_obj.reserved2.reserved1 = |
| 32537 | fusionAlg_P_g.Constant6_Value_l2; |
| 32538 | |
| 32539 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator_at_inport_39' incorporates: |
| 32540 | * Constant: '<S266>/Constant' |
| 32541 | * Constant: '<S266>/Constant1' |
| 32542 | * Constant: '<S266>/Constant2' |
| 32543 | * Constant: '<S266>/Constant3' |
| 32544 | * Constant: '<S266>/Constant4' |
| 32545 | */ |
| 32546 | fusionAlg_B.ObjList.vision_40_obj.obj_type = fusionAlg_B.Obj_Type_im; |
| 32547 | fusionAlg_B.ObjList.vision_40_obj.obj_typeConf = fusionAlg_B.Obj_TypeConf_bu; |
| 32548 | fusionAlg_B.ObjList.vision_40_obj.obj_TTC = fusionAlg_B.Selector39.OBJ_Inv_TTC; |
| 32549 | fusionAlg_B.ObjList.vision_40_obj.obj_TTCVariance = |
| 32550 | fusionAlg_B.Selector39.OBJ_Inv_TTC_STD; |
| 32551 | fusionAlg_B.ObjList.vision_40_obj.obj_existProb = |
| 32552 | fusionAlg_P_g.Constant_Value_em; |
| 32553 | fusionAlg_B.ObjList.vision_40_obj.obj_angleOfObject = |
| 32554 | fusionAlg_P_g.Constant1_Value_oay; |
| 32555 | fusionAlg_B.ObjList.vision_40_obj.obj_Heading = |
| 32556 | fusionAlg_B.Selector39.OBJ_Heading; |
| 32557 | fusionAlg_B.ObjList.vision_40_obj.obj_Heading_STD = |
| 32558 | fusionAlg_P_g.Constant2_Value_ak; |
| 32559 | fusionAlg_B.ObjList.vision_40_obj.obj_Heading_V = |
| 32560 | fusionAlg_P_g.Constant3_Value_ma; |
| 32561 | fusionAlg_B.ObjList.vision_40_obj.obj_Heading_STD_V = |
| 32562 | fusionAlg_P_g.Constant4_Value_cl; |
| 32563 | |
| 32564 | /* DataTypeConversion: '<S223>/Data Type Conversion' */ |
| 32565 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->OBJ_FRAME_INFO.SyncID); |
| 32566 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32567 | tmp = 0.0F; |
| 32568 | } else { |
| 32569 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32570 | } |
| 32571 | |
| 32572 | fusionAlg_B.frameNum_g = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T)-tmp : |
| 32573 | (uint32_T)tmp; |
| 32574 | |
| 32575 | /* End of DataTypeConversion: '<S223>/Data Type Conversion' */ |
| 32576 | |
| 32577 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator1_at_inport_3' incorporates: |
| 32578 | * Constant: '<S272>/Constant1' |
| 32579 | * Constant: '<S272>/Constant2' |
| 32580 | * Constant: '<S272>/Constant3' |
| 32581 | */ |
| 32582 | fusionAlg_B.BusConversion_InsertedFor_Bu_pp.reserved0 = |
| 32583 | fusionAlg_P_g.Constant2_Value_aex; |
| 32584 | fusionAlg_B.BusConversion_InsertedFor_Bu_pp.reserved1 = |
| 32585 | fusionAlg_P_g.Constant1_Value_dh; |
| 32586 | fusionAlg_B.BusConversion_InsertedFor_Bu_pp.reserved2 = |
| 32587 | fusionAlg_P_g.Constant3_Value_nm; |
| 32588 | |
| 32589 | /* BusCreator: '<S223>/BusConversion_InsertedFor_Bus Creator1_at_inport_6' incorporates: |
| 32590 | * Constant: '<S273>/Constant5' |
| 32591 | * Constant: '<S273>/Constant6' |
| 32592 | */ |
| 32593 | fusionAlg_B.BusConversion_InsertedFor_Bu_md.reserved0 = |
| 32594 | fusionAlg_P_g.Constant5_Value_ibw; |
| 32595 | fusionAlg_B.BusConversion_InsertedFor_Bu_md.reserved1 = |
| 32596 | fusionAlg_P_g.Constant6_Value_og; |
| 32597 | |
| 32598 | /* BusCreator: '<S223>/Bus Creator1' incorporates: |
| 32599 | * Constant: '<S223>/Constant40' |
| 32600 | * Constant: '<S223>/Constant41' |
| 32601 | * Constant: '<S223>/Constant42' |
| 32602 | */ |
| 32603 | fusionAlg_B.BusCreator1.timestamp = fusionAlg_P_g.Constant42_Value; |
| 32604 | fusionAlg_B.BusCreator1.frameNum = fusionAlg_B.frameNum_g; |
| 32605 | fusionAlg_B.BusCreator1.count = fusionAlg_P_g.Constant40_Value; |
| 32606 | fusionAlg_B.BusCreator1.reserved = fusionAlg_B.BusConversion_InsertedFor_Bu_pp; |
| 32607 | fusionAlg_B.BusCreator1.objList = fusionAlg_B.ObjList; |
| 32608 | fusionAlg_B.BusCreator1.dayNightState = fusionAlg_P_g.Constant41_Value; |
| 32609 | fusionAlg_B.BusCreator1.reserved1 = |
| 32610 | fusionAlg_B.BusConversion_InsertedFor_Bu_md; |
| 32611 | |
| 32612 | /* DataTypeConversion: '<S717>/Data Type Conversion' */ |
| 32613 | tmp = (real32_T)floor |
| 32614 | (rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_Age); |
| 32615 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32616 | tmp = 0.0F; |
| 32617 | } else { |
| 32618 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32619 | } |
| 32620 | |
| 32621 | fusionAlg_B.BusCreator1_hkq.lreage = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32622 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32623 | |
| 32624 | /* End of DataTypeConversion: '<S717>/Data Type Conversion' */ |
| 32625 | |
| 32626 | /* DataTypeConversion: '<S717>/Data Type Conversion1' */ |
| 32627 | tmp = (real32_T)floor |
| 32628 | (rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_Type); |
| 32629 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32630 | tmp = 0.0F; |
| 32631 | } else { |
| 32632 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32633 | } |
| 32634 | |
| 32635 | fusionAlg_B.BusCreator1_hkq.lretype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32636 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32637 | |
| 32638 | /* End of DataTypeConversion: '<S717>/Data Type Conversion1' */ |
| 32639 | |
| 32640 | /* DataTypeConversion: '<S717>/Data Type Conversion2' */ |
| 32641 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_ID); |
| 32642 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32643 | tmp = 0.0F; |
| 32644 | } else { |
| 32645 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32646 | } |
| 32647 | |
| 32648 | fusionAlg_B.BusCreator1_hkq.lreid = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 32649 | -tmp : (uint32_T)tmp; |
| 32650 | |
| 32651 | /* End of DataTypeConversion: '<S717>/Data Type Conversion2' */ |
| 32652 | |
| 32653 | /* DataTypeConversion: '<S717>/Data Type Conversion3' */ |
| 32654 | tmp = (real32_T)floor |
| 32655 | (rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_Side); |
| 32656 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32657 | tmp = 0.0F; |
| 32658 | } else { |
| 32659 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32660 | } |
| 32661 | |
| 32662 | fusionAlg_B.BusCreator1_hkq.lreside = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32663 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32664 | |
| 32665 | /* End of DataTypeConversion: '<S717>/Data Type Conversion3' */ |
| 32666 | |
| 32667 | /* DataTypeConversion: '<S717>/Data Type Conversion4' */ |
| 32668 | tmp = (real32_T)floor |
| 32669 | (rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_Index); |
| 32670 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32671 | tmp = 0.0F; |
| 32672 | } else { |
| 32673 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32674 | } |
| 32675 | |
| 32676 | fusionAlg_B.BusCreator1_hkq.lreindex = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32677 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32678 | |
| 32679 | /* End of DataTypeConversion: '<S717>/Data Type Conversion4' */ |
| 32680 | |
| 32681 | /* BusCreator: '<S717>/Bus Creator1' */ |
| 32682 | fusionAlg_B.BusCreator1_hkq.lreexistprob = |
| 32683 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_ExistProb; |
| 32684 | fusionAlg_B.BusCreator1_hkq.lrelineC0 = |
| 32685 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_LineC0; |
| 32686 | fusionAlg_B.BusCreator1_hkq.lrelineC1 = |
| 32687 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_LineC1; |
| 32688 | fusionAlg_B.BusCreator1_hkq.lrelineC2 = |
| 32689 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_LineC2; |
| 32690 | fusionAlg_B.BusCreator1_hkq.lrelineC3 = |
| 32691 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_LineC3; |
| 32692 | fusionAlg_B.BusCreator1_hkq.lrevrStart = |
| 32693 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_Start; |
| 32694 | fusionAlg_B.BusCreator1_hkq.lrevrEnd = |
| 32695 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_End; |
| 32696 | fusionAlg_B.BusCreator1_hkq.lreheight = |
| 32697 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_Height; |
| 32698 | fusionAlg_B.BusCreator1_hkq.lreheightstd = |
| 32699 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtHeader.LRE_Height_STD; |
| 32700 | |
| 32701 | /* DataTypeConversion: '<S714>/Data Type Conversion' */ |
| 32702 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_Age); |
| 32703 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32704 | tmp = 0.0F; |
| 32705 | } else { |
| 32706 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32707 | } |
| 32708 | |
| 32709 | fusionAlg_B.BusCreator1_ir.lreage = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 32710 | -tmp : (uint32_T)tmp; |
| 32711 | |
| 32712 | /* End of DataTypeConversion: '<S714>/Data Type Conversion' */ |
| 32713 | |
| 32714 | /* DataTypeConversion: '<S714>/Data Type Conversion1' */ |
| 32715 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_Type); |
| 32716 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32717 | tmp = 0.0F; |
| 32718 | } else { |
| 32719 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32720 | } |
| 32721 | |
| 32722 | fusionAlg_B.BusCreator1_ir.lretype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32723 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32724 | |
| 32725 | /* End of DataTypeConversion: '<S714>/Data Type Conversion1' */ |
| 32726 | |
| 32727 | /* DataTypeConversion: '<S714>/Data Type Conversion2' */ |
| 32728 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_ID); |
| 32729 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32730 | tmp = 0.0F; |
| 32731 | } else { |
| 32732 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32733 | } |
| 32734 | |
| 32735 | fusionAlg_B.BusCreator1_ir.lreid = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 32736 | -tmp : (uint32_T)tmp; |
| 32737 | |
| 32738 | /* End of DataTypeConversion: '<S714>/Data Type Conversion2' */ |
| 32739 | |
| 32740 | /* DataTypeConversion: '<S714>/Data Type Conversion3' */ |
| 32741 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_Side); |
| 32742 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32743 | tmp = 0.0F; |
| 32744 | } else { |
| 32745 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32746 | } |
| 32747 | |
| 32748 | fusionAlg_B.BusCreator1_ir.lreside = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32749 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32750 | |
| 32751 | /* End of DataTypeConversion: '<S714>/Data Type Conversion3' */ |
| 32752 | |
| 32753 | /* DataTypeConversion: '<S714>/Data Type Conversion4' */ |
| 32754 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_Index); |
| 32755 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32756 | tmp = 0.0F; |
| 32757 | } else { |
| 32758 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32759 | } |
| 32760 | |
| 32761 | fusionAlg_B.BusCreator1_ir.lreindex = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32762 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32763 | |
| 32764 | /* End of DataTypeConversion: '<S714>/Data Type Conversion4' */ |
| 32765 | |
| 32766 | /* BusCreator: '<S714>/Bus Creator1' */ |
| 32767 | fusionAlg_B.BusCreator1_ir.lreexistprob = |
| 32768 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_ExistProb; |
| 32769 | fusionAlg_B.BusCreator1_ir.lrelineC0 = |
| 32770 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_LineC0; |
| 32771 | fusionAlg_B.BusCreator1_ir.lrelineC1 = |
| 32772 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_LineC1; |
| 32773 | fusionAlg_B.BusCreator1_ir.lrelineC2 = |
| 32774 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_LineC2; |
| 32775 | fusionAlg_B.BusCreator1_ir.lrelineC3 = |
| 32776 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_LineC3; |
| 32777 | fusionAlg_B.BusCreator1_ir.lrevrStart = |
| 32778 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_Start; |
| 32779 | fusionAlg_B.BusCreator1_ir.lrevrEnd = |
| 32780 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_End; |
| 32781 | fusionAlg_B.BusCreator1_ir.lreheight = |
| 32782 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_Height; |
| 32783 | fusionAlg_B.BusCreator1_ir.lreheightstd = |
| 32784 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtA.LRE_Height_STD; |
| 32785 | |
| 32786 | /* DataTypeConversion: '<S715>/Data Type Conversion' */ |
| 32787 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_Age); |
| 32788 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32789 | tmp = 0.0F; |
| 32790 | } else { |
| 32791 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32792 | } |
| 32793 | |
| 32794 | fusionAlg_B.BusCreator1_pxb.lreage = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32795 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32796 | |
| 32797 | /* End of DataTypeConversion: '<S715>/Data Type Conversion' */ |
| 32798 | |
| 32799 | /* DataTypeConversion: '<S715>/Data Type Conversion1' */ |
| 32800 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_Type); |
| 32801 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32802 | tmp = 0.0F; |
| 32803 | } else { |
| 32804 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32805 | } |
| 32806 | |
| 32807 | fusionAlg_B.BusCreator1_pxb.lretype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32808 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32809 | |
| 32810 | /* End of DataTypeConversion: '<S715>/Data Type Conversion1' */ |
| 32811 | |
| 32812 | /* DataTypeConversion: '<S715>/Data Type Conversion2' */ |
| 32813 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_ID); |
| 32814 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32815 | tmp = 0.0F; |
| 32816 | } else { |
| 32817 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32818 | } |
| 32819 | |
| 32820 | fusionAlg_B.BusCreator1_pxb.lreid = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 32821 | -tmp : (uint32_T)tmp; |
| 32822 | |
| 32823 | /* End of DataTypeConversion: '<S715>/Data Type Conversion2' */ |
| 32824 | |
| 32825 | /* DataTypeConversion: '<S715>/Data Type Conversion3' */ |
| 32826 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_Side); |
| 32827 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32828 | tmp = 0.0F; |
| 32829 | } else { |
| 32830 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32831 | } |
| 32832 | |
| 32833 | fusionAlg_B.BusCreator1_pxb.lreside = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32834 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32835 | |
| 32836 | /* End of DataTypeConversion: '<S715>/Data Type Conversion3' */ |
| 32837 | |
| 32838 | /* DataTypeConversion: '<S715>/Data Type Conversion4' */ |
| 32839 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_Index); |
| 32840 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32841 | tmp = 0.0F; |
| 32842 | } else { |
| 32843 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32844 | } |
| 32845 | |
| 32846 | fusionAlg_B.BusCreator1_pxb.lreindex = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32847 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32848 | |
| 32849 | /* End of DataTypeConversion: '<S715>/Data Type Conversion4' */ |
| 32850 | |
| 32851 | /* BusCreator: '<S715>/Bus Creator1' */ |
| 32852 | fusionAlg_B.BusCreator1_pxb.lreexistprob = |
| 32853 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_ExistProb; |
| 32854 | fusionAlg_B.BusCreator1_pxb.lrelineC0 = |
| 32855 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_LineC0; |
| 32856 | fusionAlg_B.BusCreator1_pxb.lrelineC1 = |
| 32857 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_LineC1; |
| 32858 | fusionAlg_B.BusCreator1_pxb.lrelineC2 = |
| 32859 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_LineC2; |
| 32860 | fusionAlg_B.BusCreator1_pxb.lrelineC3 = |
| 32861 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_LineC3; |
| 32862 | fusionAlg_B.BusCreator1_pxb.lrevrStart = |
| 32863 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_Start; |
| 32864 | fusionAlg_B.BusCreator1_pxb.lrevrEnd = |
| 32865 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_End; |
| 32866 | fusionAlg_B.BusCreator1_pxb.lreheight = |
| 32867 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_Height; |
| 32868 | fusionAlg_B.BusCreator1_pxb.lreheightstd = |
| 32869 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtB.LRE_Height_STD; |
| 32870 | |
| 32871 | /* DataTypeConversion: '<S716>/Data Type Conversion' */ |
| 32872 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_Age); |
| 32873 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32874 | tmp = 0.0F; |
| 32875 | } else { |
| 32876 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32877 | } |
| 32878 | |
| 32879 | fusionAlg_B.BusCreator1_la.lreage = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 32880 | -tmp : (uint32_T)tmp; |
| 32881 | |
| 32882 | /* End of DataTypeConversion: '<S716>/Data Type Conversion' */ |
| 32883 | |
| 32884 | /* DataTypeConversion: '<S716>/Data Type Conversion1' */ |
| 32885 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_Type); |
| 32886 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32887 | tmp = 0.0F; |
| 32888 | } else { |
| 32889 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32890 | } |
| 32891 | |
| 32892 | fusionAlg_B.BusCreator1_la.lretype = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32893 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32894 | |
| 32895 | /* End of DataTypeConversion: '<S716>/Data Type Conversion1' */ |
| 32896 | |
| 32897 | /* DataTypeConversion: '<S716>/Data Type Conversion2' */ |
| 32898 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_ID); |
| 32899 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32900 | tmp = 0.0F; |
| 32901 | } else { |
| 32902 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32903 | } |
| 32904 | |
| 32905 | fusionAlg_B.BusCreator1_la.lreid = tmp < 0.0F ? (uint32_T)-(int32_T)(uint32_T) |
| 32906 | -tmp : (uint32_T)tmp; |
| 32907 | |
| 32908 | /* End of DataTypeConversion: '<S716>/Data Type Conversion2' */ |
| 32909 | |
| 32910 | /* DataTypeConversion: '<S716>/Data Type Conversion3' */ |
| 32911 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_Side); |
| 32912 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32913 | tmp = 0.0F; |
| 32914 | } else { |
| 32915 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32916 | } |
| 32917 | |
| 32918 | fusionAlg_B.BusCreator1_la.lreside = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32919 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32920 | |
| 32921 | /* End of DataTypeConversion: '<S716>/Data Type Conversion3' */ |
| 32922 | |
| 32923 | /* DataTypeConversion: '<S716>/Data Type Conversion4' */ |
| 32924 | tmp = (real32_T)floor(rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_Index); |
| 32925 | if (rtIsNaNF(tmp) || rtIsInfF(tmp)) { |
| 32926 | tmp = 0.0F; |
| 32927 | } else { |
| 32928 | tmp = (real32_T)fmod(tmp, 4.294967296E+9); |
| 32929 | } |
| 32930 | |
| 32931 | fusionAlg_B.BusCreator1_la.lreindex = tmp < 0.0F ? (uint32_T)-(int32_T) |
| 32932 | (uint32_T)-tmp : (uint32_T)tmp; |
| 32933 | |
| 32934 | /* End of DataTypeConversion: '<S716>/Data Type Conversion4' */ |
| 32935 | |
| 32936 | /* BusCreator: '<S716>/Bus Creator1' */ |
| 32937 | fusionAlg_B.BusCreator1_la.lreexistprob = |
| 32938 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_ExistProb; |
| 32939 | fusionAlg_B.BusCreator1_la.lrelineC0 = |
| 32940 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_LineC0; |
| 32941 | fusionAlg_B.BusCreator1_la.lrelineC1 = |
| 32942 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_LineC1; |
| 32943 | fusionAlg_B.BusCreator1_la.lrelineC2 = |
| 32944 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_LineC2; |
| 32945 | fusionAlg_B.BusCreator1_la.lrelineC3 = |
| 32946 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_LineC3; |
| 32947 | fusionAlg_B.BusCreator1_la.lrevrStart = |
| 32948 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_Start; |
| 32949 | fusionAlg_B.BusCreator1_la.lrevrEnd = |
| 32950 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_End; |
| 32951 | fusionAlg_B.BusCreator1_la.lreheight = |
| 32952 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_Height; |
| 32953 | fusionAlg_B.BusCreator1_la.lreheightstd = |
| 32954 | rtu_EyeQ4_Info_st->ROADEDGE_ST.RoadEdgeProtC.LRE_Height_STD; |
| 32955 | |
| 32956 | /* BusCreator: '<S224>/Bus Creator' incorporates: |
| 32957 | * Constant: '<S224>/Constant' |
| 32958 | * Constant: '<S224>/Constant1' |
| 32959 | * Constant: '<S224>/Constant2' |
| 32960 | * Constant: '<S224>/constant' |
| 32961 | */ |
| 32962 | fusionAlg_B.BusCreator_f.timestamp = fusionAlg_P_g.constant_Value; |
| 32963 | fusionAlg_B.BusCreator_f.frameNum = fusionAlg_P_g.Constant_Value_cg; |
| 32964 | fusionAlg_B.BusCreator_f.roadEdgeProtHeader = fusionAlg_B.BusCreator1_hkq; |
| 32965 | fusionAlg_B.BusCreator_f.roadEdgeProtA = fusionAlg_B.BusCreator1_ir; |
| 32966 | fusionAlg_B.BusCreator_f.roadEdgeProtB = fusionAlg_B.BusCreator1_pxb; |
| 32967 | fusionAlg_B.BusCreator_f.roadEdgeProtC = fusionAlg_B.BusCreator1_la; |
| 32968 | fusionAlg_B.BusCreator_f.errorFlag = fusionAlg_P_g.Constant1_Value_d3; |
| 32969 | fusionAlg_B.BusCreator_f.reserved = fusionAlg_P_g.Constant2_Value_m1; |
| 32970 | |
| 32971 | /* S-Function (funsionAlg_sfun): '<S4>/FusionAlg' incorporates: |
| 32972 | * Constant: '<S4>/Constant' |
| 32973 | */ |
| 32974 | funsionAlg_sfun_Outputs_wrapper(&fusionAlg_B.BusCreator_l, |
| 32975 | &fusionAlg_B.BusCreator, &fusionAlg_B.BusCreator_fo, |
| 32976 | &fusionAlg_B.BusCreator1, &fusionAlg_B.BusCreator_n, |
| 32977 | &fusionAlg_B.BusCreator_f, &fusionAlg_P_g.Constant_Value_b0, |
| 32978 | &fusionAlg_B.FusionAlg_o1, rty_FUS_LaneOutput_st, rty_FUS_RoadEdgeOutput_st); |
| 32979 | |
| 32980 | /* BusCreator: '<S720>/Bus Creator' incorporates: |
| 32981 | * BusCreator: '<S720>/Bus Creator1' |
| 32982 | * BusCreator: '<S720>/Bus Creator2' |
| 32983 | */ |
| 32984 | fusionAlg_B.BusCreator3 = fusionAlg_B.FusionAlg_o1.objects.fus_output_01_obj; |
| 32985 | |
| 32986 | /* BusCreator: '<S731>/Bus Creator' incorporates: |
| 32987 | * BusCreator: '<S731>/Bus Creator1' |
| 32988 | * BusCreator: '<S731>/Bus Creator2' |
| 32989 | */ |
| 32990 | fusionAlg_B.BusCreator3_c = fusionAlg_B.FusionAlg_o1.objects.fus_output_02_obj; |
| 32991 | |
| 32992 | /* BusCreator: '<S742>/Bus Creator' incorporates: |
| 32993 | * BusCreator: '<S742>/Bus Creator1' |
| 32994 | * BusCreator: '<S742>/Bus Creator2' |
| 32995 | */ |
| 32996 | fusionAlg_B.BusCreator3_j = fusionAlg_B.FusionAlg_o1.objects.fus_output_03_obj; |
| 32997 | |
| 32998 | /* BusCreator: '<S753>/Bus Creator' incorporates: |
| 32999 | * BusCreator: '<S753>/Bus Creator1' |
| 33000 | * BusCreator: '<S753>/Bus Creator2' |
| 33001 | */ |
| 33002 | fusionAlg_B.BusCreator3_a = fusionAlg_B.FusionAlg_o1.objects.fus_output_04_obj; |
| 33003 | |
| 33004 | /* BusCreator: '<S755>/Bus Creator' incorporates: |
| 33005 | * BusCreator: '<S755>/Bus Creator1' |
| 33006 | * BusCreator: '<S755>/Bus Creator2' |
| 33007 | */ |
| 33008 | fusionAlg_B.BusCreator3_e = fusionAlg_B.FusionAlg_o1.objects.fus_output_05_obj; |
| 33009 | |
| 33010 | /* BusCreator: '<S756>/Bus Creator' incorporates: |
| 33011 | * BusCreator: '<S756>/Bus Creator1' |
| 33012 | * BusCreator: '<S756>/Bus Creator2' |
| 33013 | */ |
| 33014 | fusionAlg_B.BusCreator3_f = fusionAlg_B.FusionAlg_o1.objects.fus_output_06_obj; |
| 33015 | |
| 33016 | /* BusCreator: '<S757>/Bus Creator' incorporates: |
| 33017 | * BusCreator: '<S757>/Bus Creator1' |
| 33018 | * BusCreator: '<S757>/Bus Creator2' |
| 33019 | */ |
| 33020 | fusionAlg_B.BusCreator3_m = fusionAlg_B.FusionAlg_o1.objects.fus_output_07_obj; |
| 33021 | |
| 33022 | /* BusCreator: '<S758>/Bus Creator' incorporates: |
| 33023 | * BusCreator: '<S758>/Bus Creator1' |
| 33024 | * BusCreator: '<S758>/Bus Creator2' |
| 33025 | */ |
| 33026 | fusionAlg_B.BusCreator3_i = fusionAlg_B.FusionAlg_o1.objects.fus_output_08_obj; |
| 33027 | |
| 33028 | /* BusCreator: '<S759>/Bus Creator' incorporates: |
| 33029 | * BusCreator: '<S759>/Bus Creator1' |
| 33030 | * BusCreator: '<S759>/Bus Creator2' |
| 33031 | */ |
| 33032 | fusionAlg_B.BusCreator3_n = fusionAlg_B.FusionAlg_o1.objects.fus_output_09_obj; |
| 33033 | |
| 33034 | /* BusCreator: '<S721>/Bus Creator' incorporates: |
| 33035 | * BusCreator: '<S721>/Bus Creator1' |
| 33036 | * BusCreator: '<S721>/Bus Creator2' |
| 33037 | */ |
| 33038 | fusionAlg_B.BusCreator3_mn = |
| 33039 | fusionAlg_B.FusionAlg_o1.objects.fus_output_10_obj; |
| 33040 | |
| 33041 | /* BusCreator: '<S722>/Bus Creator' incorporates: |
| 33042 | * BusCreator: '<S722>/Bus Creator1' |
| 33043 | * BusCreator: '<S722>/Bus Creator2' |
| 33044 | */ |
| 33045 | fusionAlg_B.BusCreator3_cp = |
| 33046 | fusionAlg_B.FusionAlg_o1.objects.fus_output_11_obj; |
| 33047 | |
| 33048 | /* BusCreator: '<S723>/Bus Creator' incorporates: |
| 33049 | * BusCreator: '<S723>/Bus Creator1' |
| 33050 | * BusCreator: '<S723>/Bus Creator2' |
| 33051 | */ |
| 33052 | fusionAlg_B.BusCreator3_ah = |
| 33053 | fusionAlg_B.FusionAlg_o1.objects.fus_output_12_obj; |
| 33054 | |
| 33055 | /* BusCreator: '<S724>/Bus Creator' incorporates: |
| 33056 | * BusCreator: '<S724>/Bus Creator1' |
| 33057 | * BusCreator: '<S724>/Bus Creator2' |
| 33058 | */ |
| 33059 | fusionAlg_B.BusCreator3_l = fusionAlg_B.FusionAlg_o1.objects.fus_output_13_obj; |
| 33060 | |
| 33061 | /* BusCreator: '<S725>/Bus Creator' incorporates: |
| 33062 | * BusCreator: '<S725>/Bus Creator1' |
| 33063 | * BusCreator: '<S725>/Bus Creator2' |
| 33064 | */ |
| 33065 | fusionAlg_B.BusCreator3_ji = |
| 33066 | fusionAlg_B.FusionAlg_o1.objects.fus_output_14_obj; |
| 33067 | |
| 33068 | /* BusCreator: '<S726>/Bus Creator' incorporates: |
| 33069 | * BusCreator: '<S726>/Bus Creator1' |
| 33070 | * BusCreator: '<S726>/Bus Creator2' |
| 33071 | */ |
| 33072 | fusionAlg_B.BusCreator3_iy = |
| 33073 | fusionAlg_B.FusionAlg_o1.objects.fus_output_15_obj; |
| 33074 | |
| 33075 | /* BusCreator: '<S727>/Bus Creator' incorporates: |
| 33076 | * BusCreator: '<S727>/Bus Creator1' |
| 33077 | * BusCreator: '<S727>/Bus Creator2' |
| 33078 | */ |
| 33079 | fusionAlg_B.BusCreator3_ay = |
| 33080 | fusionAlg_B.FusionAlg_o1.objects.fus_output_16_obj; |
| 33081 | |
| 33082 | /* BusCreator: '<S728>/Bus Creator' incorporates: |
| 33083 | * BusCreator: '<S728>/Bus Creator1' |
| 33084 | * BusCreator: '<S728>/Bus Creator2' |
| 33085 | */ |
| 33086 | fusionAlg_B.BusCreator3_o = fusionAlg_B.FusionAlg_o1.objects.fus_output_17_obj; |
| 33087 | |
| 33088 | /* BusCreator: '<S729>/Bus Creator' incorporates: |
| 33089 | * BusCreator: '<S729>/Bus Creator1' |
| 33090 | * BusCreator: '<S729>/Bus Creator2' |
| 33091 | */ |
| 33092 | fusionAlg_B.BusCreator3_g = fusionAlg_B.FusionAlg_o1.objects.fus_output_18_obj; |
| 33093 | |
| 33094 | /* BusCreator: '<S730>/Bus Creator' incorporates: |
| 33095 | * BusCreator: '<S730>/Bus Creator1' |
| 33096 | * BusCreator: '<S730>/Bus Creator2' |
| 33097 | */ |
| 33098 | fusionAlg_B.BusCreator3_je = |
| 33099 | fusionAlg_B.FusionAlg_o1.objects.fus_output_19_obj; |
| 33100 | |
| 33101 | /* BusCreator: '<S732>/Bus Creator' incorporates: |
| 33102 | * BusCreator: '<S732>/Bus Creator1' |
| 33103 | * BusCreator: '<S732>/Bus Creator2' |
| 33104 | */ |
| 33105 | fusionAlg_B.BusCreator3_nj = |
| 33106 | fusionAlg_B.FusionAlg_o1.objects.fus_output_20_obj; |
| 33107 | |
| 33108 | /* BusCreator: '<S733>/Bus Creator' incorporates: |
| 33109 | * BusCreator: '<S733>/Bus Creator1' |
| 33110 | * BusCreator: '<S733>/Bus Creator2' |
| 33111 | */ |
| 33112 | fusionAlg_B.BusCreator3_lf = |
| 33113 | fusionAlg_B.FusionAlg_o1.objects.fus_output_21_obj; |
| 33114 | |
| 33115 | /* BusCreator: '<S734>/Bus Creator' incorporates: |
| 33116 | * BusCreator: '<S734>/Bus Creator1' |
| 33117 | * BusCreator: '<S734>/Bus Creator2' |
| 33118 | */ |
| 33119 | fusionAlg_B.BusCreator3_oa = |
| 33120 | fusionAlg_B.FusionAlg_o1.objects.fus_output_22_obj; |
| 33121 | |
| 33122 | /* BusCreator: '<S735>/Bus Creator' incorporates: |
| 33123 | * BusCreator: '<S735>/Bus Creator1' |
| 33124 | * BusCreator: '<S735>/Bus Creator2' |
| 33125 | */ |
| 33126 | fusionAlg_B.BusCreator3_k = fusionAlg_B.FusionAlg_o1.objects.fus_output_23_obj; |
| 33127 | |
| 33128 | /* BusCreator: '<S736>/Bus Creator' incorporates: |
| 33129 | * BusCreator: '<S736>/Bus Creator1' |
| 33130 | * BusCreator: '<S736>/Bus Creator2' |
| 33131 | */ |
| 33132 | fusionAlg_B.BusCreator3_b = fusionAlg_B.FusionAlg_o1.objects.fus_output_24_obj; |
| 33133 | |
| 33134 | /* BusCreator: '<S737>/Bus Creator' incorporates: |
| 33135 | * BusCreator: '<S737>/Bus Creator1' |
| 33136 | * BusCreator: '<S737>/Bus Creator2' |
| 33137 | */ |
| 33138 | fusionAlg_B.BusCreator3_bu = |
| 33139 | fusionAlg_B.FusionAlg_o1.objects.fus_output_25_obj; |
| 33140 | |
| 33141 | /* BusCreator: '<S738>/Bus Creator' incorporates: |
| 33142 | * BusCreator: '<S738>/Bus Creator1' |
| 33143 | * BusCreator: '<S738>/Bus Creator2' |
| 33144 | */ |
| 33145 | fusionAlg_B.BusCreator3_kh = |
| 33146 | fusionAlg_B.FusionAlg_o1.objects.fus_output_26_obj; |
| 33147 | |
| 33148 | /* BusCreator: '<S739>/Bus Creator' incorporates: |
| 33149 | * BusCreator: '<S739>/Bus Creator1' |
| 33150 | * BusCreator: '<S739>/Bus Creator2' |
| 33151 | */ |
| 33152 | fusionAlg_B.BusCreator3_kz = |
| 33153 | fusionAlg_B.FusionAlg_o1.objects.fus_output_27_obj; |
| 33154 | |
| 33155 | /* BusCreator: '<S740>/Bus Creator' incorporates: |
| 33156 | * BusCreator: '<S740>/Bus Creator1' |
| 33157 | * BusCreator: '<S740>/Bus Creator2' |
| 33158 | */ |
| 33159 | fusionAlg_B.BusCreator3_d = fusionAlg_B.FusionAlg_o1.objects.fus_output_28_obj; |
| 33160 | |
| 33161 | /* BusCreator: '<S741>/Bus Creator' incorporates: |
| 33162 | * BusCreator: '<S741>/Bus Creator1' |
| 33163 | * BusCreator: '<S741>/Bus Creator2' |
| 33164 | */ |
| 33165 | fusionAlg_B.BusCreator3_jp = |
| 33166 | fusionAlg_B.FusionAlg_o1.objects.fus_output_29_obj; |
| 33167 | |
| 33168 | /* BusCreator: '<S743>/Bus Creator' incorporates: |
| 33169 | * BusCreator: '<S743>/Bus Creator1' |
| 33170 | * BusCreator: '<S743>/Bus Creator2' |
| 33171 | */ |
| 33172 | fusionAlg_B.BusCreator3_ja = |
| 33173 | fusionAlg_B.FusionAlg_o1.objects.fus_output_30_obj; |
| 33174 | |
| 33175 | /* BusCreator: '<S744>/Bus Creator' incorporates: |
| 33176 | * BusCreator: '<S744>/Bus Creator1' |
| 33177 | * BusCreator: '<S744>/Bus Creator2' |
| 33178 | */ |
| 33179 | fusionAlg_B.BusCreator3_n2 = |
| 33180 | fusionAlg_B.FusionAlg_o1.objects.fus_output_31_obj; |
| 33181 | |
| 33182 | /* BusCreator: '<S745>/Bus Creator' incorporates: |
| 33183 | * BusCreator: '<S745>/Bus Creator1' |
| 33184 | * BusCreator: '<S745>/Bus Creator2' |
| 33185 | */ |
| 33186 | fusionAlg_B.BusCreator3_kc = |
| 33187 | fusionAlg_B.FusionAlg_o1.objects.fus_output_32_obj; |
| 33188 | |
| 33189 | /* BusCreator: '<S746>/Bus Creator' incorporates: |
| 33190 | * BusCreator: '<S746>/Bus Creator1' |
| 33191 | * BusCreator: '<S746>/Bus Creator2' |
| 33192 | */ |
| 33193 | fusionAlg_B.BusCreator3_ko = |
| 33194 | fusionAlg_B.FusionAlg_o1.objects.fus_output_33_obj; |
| 33195 | |
| 33196 | /* BusCreator: '<S747>/Bus Creator' incorporates: |
| 33197 | * BusCreator: '<S747>/Bus Creator1' |
| 33198 | * BusCreator: '<S747>/Bus Creator2' |
| 33199 | */ |
| 33200 | fusionAlg_B.BusCreator3_ix = |
| 33201 | fusionAlg_B.FusionAlg_o1.objects.fus_output_34_obj; |
| 33202 | |
| 33203 | /* BusCreator: '<S748>/Bus Creator' incorporates: |
| 33204 | * BusCreator: '<S748>/Bus Creator1' |
| 33205 | * BusCreator: '<S748>/Bus Creator2' |
| 33206 | */ |
| 33207 | fusionAlg_B.BusCreator3_og = |
| 33208 | fusionAlg_B.FusionAlg_o1.objects.fus_output_35_obj; |
| 33209 | |
| 33210 | /* BusCreator: '<S749>/Bus Creator' incorporates: |
| 33211 | * BusCreator: '<S749>/Bus Creator1' |
| 33212 | * BusCreator: '<S749>/Bus Creator2' |
| 33213 | */ |
| 33214 | fusionAlg_B.BusCreator3_au = |
| 33215 | fusionAlg_B.FusionAlg_o1.objects.fus_output_36_obj; |
| 33216 | |
| 33217 | /* BusCreator: '<S750>/Bus Creator' incorporates: |
| 33218 | * BusCreator: '<S750>/Bus Creator1' |
| 33219 | * BusCreator: '<S750>/Bus Creator2' |
| 33220 | */ |
| 33221 | fusionAlg_B.BusCreator3_bd = |
| 33222 | fusionAlg_B.FusionAlg_o1.objects.fus_output_37_obj; |
| 33223 | |
| 33224 | /* BusCreator: '<S751>/Bus Creator' incorporates: |
| 33225 | * BusCreator: '<S751>/Bus Creator1' |
| 33226 | * BusCreator: '<S751>/Bus Creator2' |
| 33227 | */ |
| 33228 | fusionAlg_B.BusCreator3_p = fusionAlg_B.FusionAlg_o1.objects.fus_output_38_obj; |
| 33229 | |
| 33230 | /* BusCreator: '<S752>/Bus Creator' incorporates: |
| 33231 | * BusCreator: '<S752>/Bus Creator1' |
| 33232 | * BusCreator: '<S752>/Bus Creator2' |
| 33233 | */ |
| 33234 | fusionAlg_B.BusCreator3_lm = |
| 33235 | fusionAlg_B.FusionAlg_o1.objects.fus_output_39_obj; |
| 33236 | |
| 33237 | /* BusCreator: '<S754>/Bus Creator' incorporates: |
| 33238 | * BusCreator: '<S754>/Bus Creator1' |
| 33239 | * BusCreator: '<S754>/Bus Creator2' |
| 33240 | */ |
| 33241 | fusionAlg_B.BusCreator3_ld = |
| 33242 | fusionAlg_B.FusionAlg_o1.objects.fus_output_40_obj; |
| 33243 | |
| 33244 | /* Concatenate: '<S719>/Vector Concatenate' */ |
| 33245 | rty_FUS_ObjOutput_st->objects[0] = fusionAlg_B.BusCreator3; |
| 33246 | rty_FUS_ObjOutput_st->objects[1] = fusionAlg_B.BusCreator3_c; |
| 33247 | rty_FUS_ObjOutput_st->objects[2] = fusionAlg_B.BusCreator3_j; |
| 33248 | rty_FUS_ObjOutput_st->objects[3] = fusionAlg_B.BusCreator3_a; |
| 33249 | rty_FUS_ObjOutput_st->objects[4] = fusionAlg_B.BusCreator3_e; |
| 33250 | rty_FUS_ObjOutput_st->objects[5] = fusionAlg_B.BusCreator3_f; |
| 33251 | rty_FUS_ObjOutput_st->objects[6] = fusionAlg_B.BusCreator3_m; |
| 33252 | rty_FUS_ObjOutput_st->objects[7] = fusionAlg_B.BusCreator3_i; |
| 33253 | rty_FUS_ObjOutput_st->objects[8] = fusionAlg_B.BusCreator3_n; |
| 33254 | rty_FUS_ObjOutput_st->objects[9] = fusionAlg_B.BusCreator3_mn; |
| 33255 | rty_FUS_ObjOutput_st->objects[10] = fusionAlg_B.BusCreator3_cp; |
| 33256 | rty_FUS_ObjOutput_st->objects[11] = fusionAlg_B.BusCreator3_ah; |
| 33257 | rty_FUS_ObjOutput_st->objects[12] = fusionAlg_B.BusCreator3_l; |
| 33258 | rty_FUS_ObjOutput_st->objects[13] = fusionAlg_B.BusCreator3_ji; |
| 33259 | rty_FUS_ObjOutput_st->objects[14] = fusionAlg_B.BusCreator3_iy; |
| 33260 | rty_FUS_ObjOutput_st->objects[15] = fusionAlg_B.BusCreator3_ay; |
| 33261 | rty_FUS_ObjOutput_st->objects[16] = fusionAlg_B.BusCreator3_o; |
| 33262 | rty_FUS_ObjOutput_st->objects[17] = fusionAlg_B.BusCreator3_g; |
| 33263 | rty_FUS_ObjOutput_st->objects[18] = fusionAlg_B.BusCreator3_je; |
| 33264 | rty_FUS_ObjOutput_st->objects[19] = fusionAlg_B.BusCreator3_nj; |
| 33265 | rty_FUS_ObjOutput_st->objects[20] = fusionAlg_B.BusCreator3_lf; |
| 33266 | rty_FUS_ObjOutput_st->objects[21] = fusionAlg_B.BusCreator3_oa; |
| 33267 | rty_FUS_ObjOutput_st->objects[22] = fusionAlg_B.BusCreator3_k; |
| 33268 | rty_FUS_ObjOutput_st->objects[23] = fusionAlg_B.BusCreator3_b; |
| 33269 | rty_FUS_ObjOutput_st->objects[24] = fusionAlg_B.BusCreator3_bu; |
| 33270 | rty_FUS_ObjOutput_st->objects[25] = fusionAlg_B.BusCreator3_kh; |
| 33271 | rty_FUS_ObjOutput_st->objects[26] = fusionAlg_B.BusCreator3_kz; |
| 33272 | rty_FUS_ObjOutput_st->objects[27] = fusionAlg_B.BusCreator3_d; |
| 33273 | rty_FUS_ObjOutput_st->objects[28] = fusionAlg_B.BusCreator3_jp; |
| 33274 | rty_FUS_ObjOutput_st->objects[29] = fusionAlg_B.BusCreator3_ja; |
| 33275 | rty_FUS_ObjOutput_st->objects[30] = fusionAlg_B.BusCreator3_n2; |
| 33276 | rty_FUS_ObjOutput_st->objects[31] = fusionAlg_B.BusCreator3_kc; |
| 33277 | rty_FUS_ObjOutput_st->objects[32] = fusionAlg_B.BusCreator3_ko; |
| 33278 | rty_FUS_ObjOutput_st->objects[33] = fusionAlg_B.BusCreator3_ix; |
| 33279 | rty_FUS_ObjOutput_st->objects[34] = fusionAlg_B.BusCreator3_og; |
| 33280 | rty_FUS_ObjOutput_st->objects[35] = fusionAlg_B.BusCreator3_au; |
| 33281 | rty_FUS_ObjOutput_st->objects[36] = fusionAlg_B.BusCreator3_bd; |
| 33282 | rty_FUS_ObjOutput_st->objects[37] = fusionAlg_B.BusCreator3_p; |
| 33283 | rty_FUS_ObjOutput_st->objects[38] = fusionAlg_B.BusCreator3_lm; |
| 33284 | rty_FUS_ObjOutput_st->objects[39] = fusionAlg_B.BusCreator3_ld; |
| 33285 | |
| 33286 | /* BusCreator: '<S718>/Bus Creator' */ |
| 33287 | rty_FUS_ObjOutput_st->timeStamp = fusionAlg_B.FusionAlg_o1.timeStamp; |
| 33288 | rty_FUS_ObjOutput_st->frameNum = fusionAlg_B.FusionAlg_o1.frameNum; |
| 33289 | } |
| 33290 | |
| 33291 | /* Termination for referenced model: 'fusionAlg' */ |
| 33292 | void fusionAlg_Term(void) |
| 33293 | { |
| 33294 | /* Terminate for S-Function (funsionAlg_sfun): '<S4>/FusionAlg' incorporates: |
| 33295 | * Constant: '<S4>/Constant' |
| 33296 | */ |
| 33297 | |
| 33298 | /* S-Function Block: <S4>/FusionAlg */ |
| 33299 | funsionAlg_sfun_Terminate_wrapper(); |
| 33300 | } |
| 33301 | |
| 33302 | /* Model initialize function */ |
| 33303 | void fusionAlg_initialize(const char_T **rt_errorStatus) |
| 33304 | { |
| 33305 | RT_MODEL_fusionAlg_T *const fusionAlg_M = &(fusionAlg_MdlrefDW.rtm); |
| 33306 | |
| 33307 | /* Registration code */ |
| 33308 | |
| 33309 | /* initialize non-finites */ |
| 33310 | rt_InitInfAndNaN(sizeof(real_T)); |
| 33311 | |
| 33312 | /* initialize error status */ |
| 33313 | rtmSetErrorStatusPointer(fusionAlg_M, rt_errorStatus); |
| 33314 | |
| 33315 | /* block I/O */ |
| 33316 | (void) memset(((void *) &fusionAlg_B), 0, |
| 33317 | sizeof(B_fusionAlg_c_T)); |
| 33318 | |
| 33319 | { |
| 33320 | /* user code (registration function declaration) */ |
| 33321 | /*Initialize global TRC pointers. */ |
| 33322 | fusionAlg_rti_init_trc_pointers(); |
| 33323 | RTI_INIT_CODE_ENV(); |
| 33324 | } |
| 33325 | } |
| 33326 | |